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Wisconsin businesses have long 
been world leaders in the development 
of automated manufacturing. That’s 
because the state has what it takes to 
keep them— and you— on the leading 
edge of technology. If you’re looking 
into expanding or relocating, look into 
what Wisconsin has to offer. 

Our progressive business climate, 
for example. Or our highly funded uni- 
versity research programs and pro- 
ductive workforce. Our low corporate 
taxes and low-cost electric power. Plus 
a quality of life that’ll make all your 
work worthwhile. 


The heart of high-tech activity in 
Wisconsin is an area in the southeast 
corner of the state linked by Interstate 
94. It’s the business address of re- 
searchers, entrepreneurs and investors 
who have found a strategy for success 
and a place to enjoy it. 

Let us show you how the “1-94 
Connection” can pave the way for your 
business success. Send for a free 
10-minute videotape introduction, or 
call our economic development profes- 
sionals at 414/277-3842. 

You’ll see why Wisconsin business is 
in a fine state. 


YES! Please send me your free videotape introduction to Wisconsin entitled, "The 1-94 Connection.’ 
Name Title 


Company . 
Address _ 


Phone . 




Wisconsin 
Electric 

J POWER COMPANY 

Check video format needed: □ Vz VHS □ 34 " Beta 

Send to: Office of Economic Development, Wisconsin Electric Power Company, 231 W. Michigan St., Milwaukee, Wl 53203 
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6 The Exact Inverse Kinematics 
Solutions for the Rhino XR-2 
Robot Manipulator 

by M. Shahinpoor 


By using the Denavit-Hartenberg homogeneous transformations of robotic moving 
coordinate systems, as well as matrix manipulation, a set of exact inverse kinematics 
solutions can be obtained for the Rhino XR-2 robot. 
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with Computer Graphics 

Now that computers can be used to build more computers, some of which are 
robots, the robotics systems engineer can, from a desktop workstation, create 
and interact with dynamic visual depictions of robotic mechanisms. 
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Derived from Planes 
of Movement 

The motion of robotic links and joints can be developed in terms of planes of 
motion, and their kinematic solutions can be derived as a subset of these planes, 
the “planes with area.” In this article the forward kinematic solutions are obtained 
symbolically, and the analysis is extended to the determination of symbolic in- 
verse kinematic solutions. 
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Workcell Design 
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Editorial 


Robots 9 . . . and other topics 

BY CARL HELMERS 


We travelled to Detroit in early June for 
the latest edition of Robots 9, the annual 
SME robotics convention. The event was 
held again in Cobo Hall and was attended 
by about 20,000 people. Exhibits and 
educational sessions covered the entire 
breadth of the industrial robotics field, and 
I came away with three strong impressions. 

First, manufacturing cells were there in 
abundance. Especially fine examples were 
the educational and training cells from 
Madwed and from Prep, Inc. Also of in- 
terest were industrial cells like the General 
Electric assembly cell, which was to be 
packed up and shipped to one of that com- 
pany’s plants after the show. 


Second, the era of the autonomous in- 
dustrial/commercial robot has begun. Dur- 
ing the convention a long-time friend 
dropped by our booth. A solid state 
physicist by training, he works for a very 
large computer company where his current 
activities include robotics-related research. 
He also happens to be a pioneer in private 
autonomous robot experimentation. He 
virtually dragged me over to the Intelledex 
booth to see one of their robot arms 
mounted atop an autonomous mobile 
robot made by another firm for use in 
transporting semiconductor wafer carriers 
between clean room stations. Here was a 
true application of concepts that so far 


have been seen only in experimental per- 
sonal robots. 

Third, it was at this show that GMF 
Robotics introduced its new robotics 
development language called Karel, easily 
the most significant new software product 
I saw. Karel finally brings to the real-time 
computer side of robotics a language and 
development system environment suitable 
for large, complex projects that must live 
in an organization over many, many years 
and through the tenure of many, many 
programming professionals. The language 
is an implementation of a Pascal-like block 
structured computer language together 
with a language-oriented development en- 
vironment. Much more will be said about 
Karel in future issues of Robotics Age. 


DECOD I NG THE ACRON YMS 

Sometimes it is necessary to restate the 
obvious, such as to note that CIM stands 
for “computer integrated manufacturing.” 
In order to accomplish CIM, we need to 
apply the two components of CAD (com- 
puter aided design) and CAM (computer 
aided manufacturing) glued together with 
a MAP. In today’s robotics environment 
the MAP (manufacturing automation pro- 
tocol) is becoming a standard form of hard- 
ware and software telecommunications 
techniques. One way to implement the 
CAM part of CIM is to combine one or 
more FMS (flexible manufacturing system) 
work cells, often coupled by AGVs 
(automatic guided vehicles) using the MAP 
for communications. 


VISION S OF THE FUT URE 

From time to time, Robotics Age peers 
into the future. At a recent staff meeting 
we did this by deciding on themes for 
forthcoming issues and organizing them 
into an editorial calendar for 1986. The 
calendar is available to those interested in 
writing for us— drop a line and we will send 
you a copy. ■ 
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Calendar 


AUGUST 

19-20 August. Developing End- 
of-Arm Tooling for Industrial 
Robots. Norcross (Atlanta), 
Georgia. Contact: Diane Korona, 
Program Administrator, Robotics 
International of SME, One SME 
Dr., PO Box 930, Dearborn, MI 
48121, telephone (313) 271-1500, 
ext. 392. 

This workshop, worth 12 profes- 
sional credits toward the SME 
recertification program, will focus 
on end effectors and will cover 
analysis of part, process, and robot; 
productivity; and design tech- 
niques. Also to be addressed are 
type of power to be used, floor 
layout and work envelope size, part 
configuration, cycle time, and 
robot characteristics. The con- 
ference will be held again on 22-23 
October at the Boston Park Plaza 
Hotel, Boston, MA. 

21-22 August. Applying Sen- 
sors in Robot Applications. Nor- 
cross (Atlanta), GA. Contact: Diane 
Korona, Program Administrator, 
Robotics International of SME, 
One SME Dr., PO Box 930, Dear- 
born, Ml 48121, telephone (313) 
271-1500, ext. 392. 

Highlights of this course will in- 
clude sensor types and functions, 
sensor selection techniques, inter- 
facing sensors to system com- 
ponents, and designing sensors in- 
to tooling. The course is worth 12 
credits toward the SME recertifica- 
tion program. 

27-29 August. Flexible 
Manufacturing Cells. Americana 
Hotel, Dearborn, MI. Contact: Sally 
Davis, Special Programs Division, 
Computer and Automated Systems 
Association of SME, One SME Dr., 
PO Box 930, Dearborn, MI 48121, 
telephone (313) 271-1500, ext. 
383. 

This seminar will provide an in- 
troduction to and definition of flex- 
ible manufacturing cells. Planning 
considerations, components, 


peripherals, gauging and inspec- 
tion, and software considerations 
will also be discussed. A number 
of user case study presentations 
have been scheduled by Cummins 
Engine, Rockwell International, 
and Digital Equipment, among 
other companies. 


SEPTEMBER 

6-8 September. International Per- 
sonal Robot Congress & Exposi- 
tion. Moscone Center, San Fran- 
cisco, CA. Contact: Sharon D. 
Smith, Chair, IPRC ‘85 Organizing 
Committee, 8822 S. Martin Lane, 
Conifer, CO 80433, telephone 
(303) 674-5650. 

The second annual IPRC, ex- 
pected by the organizers to attract 
over 2500 personal robot en- 
thusiasts, will feature seminars on 
personal robot software and hard- 
ware, human services, robots in 
space, the business of personal 
robots, and personal robots in 
education. 

9-10 September. Second Interna- 
tional Conference on Advanced 
Robotics. Keidanren Kaikan Bldg., 
Tokyo, Japan. Contact: Mr. A. 
Yasutake, Organizing Secretary, 
Japan Industrial Robot Associa- 
tion, Kikai Shinko Kaikan Bldg., 
3-5-8, Shibakoen, Minato-ku, 
Tokyo, 105 Japan. 

The primary objective of this 
conference is to provide an inter- 
national exchange of information 
on intelligent, mobile, and sensory 
control robots. Approximately 70 
papers will be presented. 

9-11 September. OEM Design '85. 
Philadelphia Civic Center, 
Philadelphia, PA. Contact: Penton 
Exposition Division, 122 E. 42nd 
St., New York, NY 10017, 
telephone (212) 867-9191. 

Papers to be presented at this 
conference will include the follow- 
ing topics: vision systems, off-line 


programs for robots, justifying 
robots, the status of computer- 
integrated manufacturing (CIM) as 
a business strategy, CIM in elec- 
tronics manufacturing, flexible 
manufacturing systems, and com- 
puters as design components. 

10- 12 September. Midcon/85. 
Chicago, IL. Contact: Nancy 
Hogan, Electronic Conventions 
Management, 8110 Airport Blvd., 
Los Angeles, CA 90045, telephone 
(213) 772-2965. 

The Midcon/85 conference will 
address current or near-term ad- 
vances, trends, and applications of 
electronic technology and product 
manufacture. 

11- 13 September. Fifteenth Inter- 
national Symposium on Industrial 
Robots. Keidanren Kaikan Bldg., 
Tokyo, Japan. Contact: Mr. Y. 
Komori, Organizing Secretary, 
15th ISIR, Japan Industrial Robot 
Association, Kikai Shinko Kaikan 
Bldg., 3-5-8, Shibakoen, Minato- 
ku, Tokyo, 105, Japan. 

More than 100 papers will be 
presented on the latest research, 
developments, applications, and 
socioeconomic evaluation of in- 
dustrial robots during this sym- 
posium. In addition, an interna- 
tional exhibition of industrial 
robots and their applied systems 
equipment will be held September 
12 through 16 at the exhibition hall 
of the International Trade Fair 
Center, Harumi, Tokyo. After the 
symposium, a study tour during 
which participants may visit 
Japanese robot manufacturers, 
users, and research laboratories is 
also being planned. 

17-25 September. EMO Han- 
nover. Hannover Fairgrounds, 
Hannover, Federal Republic of 
Germany. Contact: EMO General 
Commissariat, Messegelande, 
D-3000 Hannover 82, Federal 
Republic of Germany. 

The latest advances in manufac- 
turing technology and automation 


will be demonstrated in Hannover 
by 849 companies from 36 coun- 
tries at this exhibit which will 
feature computerized automation, 
control technologies, CAD-CAM, 
sensor and diagnostic technology, 
assembly, manipulating equipment 
and industrial robots, and flexible 
manufacturing systems. Foreign 
visitors will receive a free season 
ticket at the entrances to the ex- 
hibition on presentation of their 
passports. 

18-19 September. International 
Congress for Metalworking and 
Automation. Hannover, Federal 
Republic of Germany. Contact: 
EMO General Commissariat, 
Messegelande, D-3000 Hannover 
82, Federal Republic of Germany. 

The International Congress for 
Metalworking and Automation will 
take place during the 6th EMO in 
Hannover to review current 
technological developments in 
metalworking. Primary subjects to 
be discussed include flexible 
manufacturing, assembly and 
manipulating equipment, sensor 
and diagnostic equipment, and 
computer-assisted manufacturing. 

23-25 September. Space Tech ‘85. 
Disneyland Hotel Convention 
Center, Anaheim, CA. Contact: 
Gregg Balko, Technical Activities 
Dept., Society of Manufacturing 
Engineers, One SME Dr., PO Box 
930, Dearborn, MI 48121, 
telephone (313) 271-1500, ext. 
368. 

Sponsored by nine technical and 
engineering societies, SPACE 
TECH ‘85 will focus on the 
engineering technologies and solu- 
tions required to make space in- 
dustrialization practical and 
economical. There will be sessions 
discussing artificial intelligence and 
robotics; guidance, controls, and 
sensors; materials processing and 
applications; simulation and soft- 
ware; composites; space structures; 
habitation; propulsion; and 
manufacturing in space. 
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In The Robotics Age 

Edited by Stephanie vL Henkel 


AT ROBOTS 9 


At the beginning of June we 
spent an informative week at 
Robots 9, the Big One in in- 
dustrial robotics. There were 
about 250 displays, some quite 
spectacular and some less 
flashy but offering unexpected 
little gems of ingenuity. We 
tried to visit every booth and we 
hope our readers who attend- 
ed the convention paid a call on 
us. Herewith, our overall im- 
pressions of Robots 9— in no 
way a complete accounting but, 
we hope, enough to suggest the 
flavor of the show. 


Most of the machinery we 
saw had automotive manu- 
facturing applications, which 
was hardly surprising since we 
were in Detroit. Robots welded 
spots and seams, robots spray 
painted (simulated by ribbons 
streaming from the nozzles), 
and robots with high-pressure 
water jets carved out inside 
body parts for cars. 

Smaller assembly robots were 
prominent as well, and one ar- 
rangement in particular caught 
our eye. Gulf + Western had set 
up a flexible manufacturing 


system wherein an IBM 7535 
assembled 10 and 20 amp 
residential circuit breakers, a 
Seiko PN-700 transferred the 
part from the IBM to an Hitachi 
PW10II, and the Hitachi 
disassembled the breaker and 
reloaded the parts into a feeder. 
The three work envelopes 
overlapped but there was no 
jostling (Photo 1). 



Photo 1. 


We had breakfast with Bob, 
Jurgens/Acme’s three-pronged 
end effector developed for small 
parts handling. Bob (whose 
creators grew so fond of him 
they felt he needed a name) has 
a payload of 1 l h lbs. and a grip- 
ping force of 28 ounces. He 
held a succession of variously 
shaped wooden blocks (Photo 
2) and finally a raw egg without 
mishap. 



Photo 2. 


We heard an ICC spokesman 
declare that “hardware is only 
something to hold the soft- 
ware” and stayed around to 
learn about the company’s new 
integrated cell controller that 
can control up to 32 axes of 
motion and over 1000 I/O 


points— from an IBM PC. The 
motion control is based on an 
advanced digital servo tech- 
nology that reduces com- 
ponents and replaces analog 
circuitry with digital firmware. 
Sixteen of these units can be 
linked together, bringing the 
Factory of the Future pretty 
close. 

Our eyes were what led us 
over to the McDonnell Douglas 
CAD/CAE/CAM presentation. 
Running on a DEC Microvax II, 
the program simulated, among 
other wonders, two robots mov- 
ing simultaneously (Photo 3). 



Photo 3. 


The images were stunning in 
their color and crispness and 
we wondered how much time 
the company’s design engineers 
spend simply enjoying their 
CRTs. 

Next we went to admire the 
King Kong of robot arms, 
Yaskawa’s Motoman® (10 ft. 
tall, 20 ft. diameter work 
envelope, 265 lbs. payload in- 
cluding end effector). Motoman 
was designed for material 
handling, welding, palletizing, 
grinding, and deburring but at 
the convention it was showing 



Photo 4. 



GO® Solid State Proximity 
Switches 

A complete range of inductive/capacitive solid state 
proximity switches. There are many different models 
available for your application. 

Specifications: 

• Glass reinforced plastic or metal housing 

• Resistant to chemical attack, impact and vibration 

• From 5mm diameter to 34mm diameter units with 
sensing range to 40mm 

• Normally open and normally closed models 

• Full 2 year warranty 

• Switching current— 500 mA 

• Temperature range -25° to 85° 

• Voltage range: 8-30 vdc W* ^ 

80-275 vac ■ ■« ■ 

20-275 vac 

• LED standard on most models 

• Source and sink options 

General Equipment & Mfg. Co., Inc. 

P.O. Box 37290; Louisville KY 40233 (502) 969-2386 
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off, balletically displaying in 
huge scale all its axes of motion 
(Photos 4,5). 



Photo 5. 


No robot show would be 
complete without the Spine 
spray painting robot from 
Sweden (Photo 6). The design 
of this one-of-a-kind arm is 
based on the human backbone. 
A stack of stainless steel discs 
is threaded by two pairs of op- 
posed cables powered by 
hydraulic actuators. The discs 
are free to rock back and forth 



Photo 6. 


about their centers in all direc- 
tions, under the control of the 
cables. A resistive wire sensor 
tracks the motion of the cables, 
providing feedback to the con- 
trol system. The mechanism is 
amazingly flexible and the pro- 
gram is accurate enough for 
painting cars. Spine does not 
foresee any other application 
for the robot, since even laying 
on sealants would require 
greater precision than the com- 
pany cares to give this product. 


South Korea’s only manufac- 
turer of industrial robots was 
exhibiting a robotic welding 
arm and we stopped by the 
Daewoo booth (Photo 7). A 



Photo 7. 


spokesman for the new com- 
pany said its unchallenged posi- 
tion was due in part to no other 
Korean company’s having as 
yet developed the drive motors, 
and too, until recently robotic 
welders were not much in de- 
mand in Korea. He anticipated 
that his product would end up 


cost-competitive with similar 
welders from Japan. 

We heard a voice saying 
“Help me” and we hurried over 
to investigate. Intel was 
demonstrating a remarkable 
speech recognition system and 
“help me” brought up the 
menu. This system is so user- 
friendly that it takes into ac- 
count human impatience. Peo- 
ple, an Intel spokesman ex- 
plained, never say the same 
word twice in precisely the 
same way. An unsophisticated 
voice recognition system re- 
sponds to such deviations by 
asking “What?” over and over 
until the user is ready to throw 
it out the nearest window. In- 
tel’s system understands speech 
nuances rather well, and when 
there is a question it tells the 
Continued on page 34 


Csharp Realtime Toolkit 



Realtime on MSDOS? Csharp can do it! Get the tools without operating system overhead. Cut development time with C source 
code for realtime data acquisition and control. Csharp includes: graphics, event handling, procedure scheduling, state system 
control, and interrupt handling. Processor, device, and operating system independent. Csharp runs standalone or with: MSDOS, 
PCDOS, or RT11. Csharp runs on: PDP-11 and IBM PC. Csharp includes drivers for Hercules and IBM graphics boards. Data 
Translation and Metrabyte IO boards, real time clock, and more. Inquire for Victor 9000, Unix, and other systems. Price: $600 



TEMS 
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Systems Guild, Inc., P.O. Box 1085, Cambridge, MA 02142 
(617) 451-8479 
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THE EXACT INVERSE 
KINEMATICS SOLUTIONS 
FOR THE RHINO XH-2 
ROROT MANIPULATOR 

M. Shahinpoor 

Department of Mechanical Engineering 
University of New Mexico 
Albuquerque, NM 87131 


The inverse kinematics problem in robotic manipulation is 
to find the vector of the joint angles, say for an n-axis revolute 
manipulator, given the position and the orientation (attitude) 
of its gripper. The attitude vector— or, more generally, the at- 
titude matrix— describes the position of the origin, and the rota- 
tional orientation, of a convective coordinate frame embedded 
in the gripper frame with respect to a fixed reference frame at 
the base of the robot manipulator. 

No exact inverse kinematics solutions exist as yet for a general 
n-axis robot, or, in particular, for the general 6-axis robot 
manipulator widely used in high-tech automation. It is sometimes 
possible to solve the inverse kinematics problem for certain 
special classes of n-axis robot manipulators, even though in most 
cases the amount of algebraic and trigonometric manipulations 
turns out to be horrendous. The mathematical problem is com- 
posed of a set of twelve equations for n unknowns pertaining 
to an n-axis manipulator. The problem is complex with a nonu- 
nique set of solutions or sometimes no solutions at all. The in- 
verse kinematics is a subset of a much larger and much more 
difficult “the inverse dynamics.” The inverse dynamics essen- 
tially seeks to find the vector of the joint torques given the forces 
and the torques (dynamic attitude) on the gripper. 

Historically, Pieper [1] and Pieper and Roth [2] were the first 
to derive a set of solutions for a number of special robot 
manipulators. They also devoted a portion of their work to 
iterative-type algorithms to numerically solve the inverse 
kinematics problem. Paul [3] has demonstrated inverse 
kinematics solutions for the Stanford (cylindrical polar) and a 
6-axis elbow manipulator. Hollerbach and Gideon [4] have also 
obtained a set of inverse kinematics solutions for a special class 
of robot manipulators. The practice in the industry is to con- 
sider a robot manipulator and try to obtain inverse kinematics 
solutions to be incorporated in the pertinent software. 
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Sometimes it is almost impossible to find exact solutions to the 
inverse kinematics problem of general 6-axis industrial robots. 
Attempts have been made to tackle this problem by means of 
iterative algorithms. For example, Lumelsky [5] presented 
iterative solutions for the inverse kinematics problem for one 
type of robot manipulator and Campbell [6] and Shahinpoor and 
Campbell [7] have employed Powell’s [8] optimization technique 
to arrive at an iterative algorithm for the inverse kinematics solu- 
tion of a general n-axis robot manipulator. However, the typical 
computation time for a 6-axis robot on a VAX-1 1/780 computer 
has been observed to be about 1 to 25 seconds which is 
undesirable. One should mention also the recent exact solutions 
of Tsai and Morgan [9] and Shahinpoor, Jamshidi, and Kim [10]. 

This article presents a set of exact solutions for a Rhino XR-2, 
a 5-axis, 6 degrees of freedom revolute robot. In the next sec- 
tion are developed the governing equations for the Rhino XR-2 
robot arm kinematics. In deriving the governing equations the 
Denavit-Hartenberg [1 1] homogeneous transformations are used 
to set up the inverse kinematics problem. After the solutions 
have been found, the computer algorithm for the inverse 
kinematics solutions for the Rhino XR-2 will be presented. The 
Rhino XR-2 is widely used in many U.S. educational institutions 
and in private industry, and it is becoming a standard teaching 
and research tool in robotics education. 


R HINO XR-2 ROBOT KINEMATICS 

The Rhino XR-2 robot manipulator is an open-loop kinematic 
chain (Photo 1). One end of this manipulator is fixed in an iner- 
tial frame and is called the base. 

At the other end of the chain is the gripper or an end-effector 
that is activated by a motorized four-bar mechanism. The chain 
is made up of a series of links and joints. The position of the 


end-effector or the gripper is described by a position vector ex- 
tended from the origin of the base coordinate frame to the origin 
of a convective frame attached to the gripper. The orientation 
of the gripper is described by a rotation matrix expressing the 
relative rotation of the gripper frame with respect to the reference 
frame at the base. The totality of position and orientation of 
one coordinate frame with respect to another can be described 
by a 4 by 4 matrix that has been called the attitude matrix [10]. 
These matrices were originally conceived of and derived in a 
classic work by Denavit and Hartenberg [11] and are called 
Denavit-Hartenberg (D-H) A matrices. The D-H matrices are 
essentially 4 by 4 homogeneous transformations sufficient for 
the description of the complete kinematic properties of lower- 
pair mechanisms. Lower-pair mechanisms are defined by mutual 
contact between one part and another, with one surface sliding 
with respect to the other. 

Four parameters represent the coordinates of any lower pair. 
These parameters are a, alpha a, theta 0, and d. The parameter 
a is known as the link length, alpha is the link twist, theta is 
the link angle, and d is the link distance. The coordinates for 
the Denavit-Hartenberg notation are defined in Figure 1. In 
general, two links are connected by a “lower-pair” joint that has 
two contacting or sliding surfaces. As mentioned before, a joint 
axis (say the ith joint) is established at the connection of two 
links. 

The coordinates are chosen as follows: 

1. The z j coordinate is along the axis of motion or rotation of 
the (i + l)th joint. 

2. The x j axis is in the direction of normal to both z - x and z M 
axes, pointing away from the z j_ 2 axis (such as to make an r.h. 
coordinate with z x and z^). 

3. The y j coordinate is chosen so as to make the x j y x z - x coor- 
dinate system a right-handed coordinate system. 

4. The distance between the two normals aj and a x . } is called 
the link distance d j. 



Photo 1. The Rhino XR-2 robot manipulator is shown in multiple exposures. 



Figure 1. The coordinates for the Denavit-Hartenberg notation can be generalized 
as two links connected by a “lower-pair” joint that has two contacting or sliding 
surfaces. A joint axis is established at the connection of two links. 


5. The lengths of the normal a j is the minimum distance be- 
tween the Zj and Zj.j axes. If this is zero, the direction of aj 
becomes arbitrary, aj is also referred to as the length of the 
link i. 

6. The relative orientation of the Xj axis with respect to x^ 
axis is called 0 - x = (x if x or the vector of the joint angles. 

7. The relative orientation of z x axis with respect to z M axis 
is called a x = (z x , z M ), or the vector of the twist angles. 

The four parameters d x , 9 x , a x and a - x constitute a minimally 
sufficient set to determine the kinematic configuration of each 
link of the robotic arm. Note that 
d j = joint distance, 9 s = joint angle, a j = link length, a x 
= length twist angle. 

Note that for a plane revolute joint, generally d x , a x and a - x 
are all constant, while 9 - x varies as link i rotates about the axis 
of joint i. On the other hand, for a prismatic joint 9 x , a x and 
a j are constant while d j varies as link i slides along the axis 
of joint i. 

Once the D-H coordinate system for each link is established, 
a homogeneous transformation matrix can easily be developed 
relating the ith coordinate frame to the (i-l)th coordinate frame. 
Referring to Figure 1, it is clear that a point £ x expressed in 
the ith coordinate system may be expressed in the (i-l)th coor- 
dinate system a sjc x . x by performing the following successive 
transformations: 

1. Rotate about the z M axis by an angle 9 X to align the x M 
and Xj axis, R(z M , 0j), 

2. Translate along the z M axis a distance d x to bring the Xj.j 
and Xj axes into coincidence; T(z x . lf dj), 

3. Translate along the Xj axis a distance aj to bring the two 
origins into coincidence; T(Xj, aj), 

4. Rotate about the x j axis an angle a j to bring the two coor- 
dinate systems to completely coincide; R(Xj, a s ). 

Thus the complete composite transformation of link i with 
respect to link i-1 or joint i with respect to joint i — 1 is 

0 ) 

-l _ - Aj_] - , 0.j )T(Z.j _i ,d.j )T(x.j ,3-j )R(x^ ,a^ ) . 
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or 


C0i -S0.j 0 0 


10 0 0 


1 0 0 a i 


10 0 0 
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0 10 0 
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0 Cot.- -Sa.j 0 

0 0 10 


0 0 1 di 


0 0 10 


0 Sa.j Ca- 0 
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C 0 

-Ca-j S 0-j 

Sa-jSQj 

3 C 

S0i 

CaiCQi 

-Sa-jC 

a i se i 

0 

Sot i 

C ai 

d. 

1 

0 

0 

0 

1 


( 2 ) 


where S0j = sin0j, C0j = cos0j, etc. are used for compact 
notation. 

Similarly, Sj = S0j = sin0 j, Cj = cos0j, = sin (0i + 0j), 
C ijk = cos (0j + 0j + 0 k ), etc. 

We frequently omit the subscript i-1 and call A' M simply A j 
matrices pertaining to the ith joint or link. Note that A j has 
generally a form: 



" Xi 

°Xi 

a Xi 

Pxi 



Ai-1 ■ A-j - 

n y. 

°yi 

a Yi 

Pyi 


. (3) 


n zi 

° Zi 

a Zi 

Pz i 




0 

0 

0 
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and thus its inverse is simply A 

- 1 such that 




n 

x i 

n 

yi 

n 
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-(p-n) 


«!■' - • 

0 

x i 

0 

° z i 

-(p-o) 

. (4) 


a 

x i 

3 

^i 


-(P‘ 

•a) 



0 

0 

0 

1 




Furthermore if r j is the homogeneous coordinate of ith joint 
and^i.j is the homogeneous coordinate of the (i-l)th joint, it 
is clear that 


ri-At-iii.! . (5) 

where 

•j 2 (x i ,y i ,z i ,l) T , (6) 

Ti.! 5 17) 


The following algorithm can be used to establish the link coor- 
dinate system: 


Algorithm 1. This procedure completely assigns link coordinate 
systems compatible with D-H transformations to a given n degree 
of freedom robot arm. Adjacent links can be related to each 
other kinematically through a set of 4 by 4 homogeneous 
transformation matrices. The first coordinate system pertain- 
ing to the base is denoted by a homogeneous system (x 0 , y 0 , 
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z 0 , 1) T at the supporting base. The origin of this system is 

denoted as the zeroth joint. 

1. Establish the base coordinate (x 0 , y 0 , z 0 ) such that z 0 axis 
lies along the axis of motion of joint 1. 

2. Initialize and loop for each i = 1, 2, n. 

3. Align all z x with the axis of motion or rotation of the joint 
i + 1. 

4. Establish the origin of the ith coordinate system either at the 
intersection of z j and z iA axes and the z { axis or at the in- 
tersection of common normal between z x and z M axes and 
the Zj axis. 

5. Establish the x x axis at each ith joint, either by x { = 
±(z [ . l xz) or along the common normal between the z x . x 
and z i when they are parallel. 

6. Establish the y x axis by y { = (z { x x j) to complete the right- 
handed coordinate system. 

7. Find dj as the distance from the origin of the (i-l)th coor- 
dinate system to the intersection of the z M axis and Xj axis. 

8. Find a j as the distance from the intersection of the z M axis 
and the x { axis to the origin of the ith coordinate system. 

9. Find 0 j as the angle of rotation from the x^ axis to the x j 
axis; 0j = (x i _ 1 ,x i ). 

10. Find a j as the angle of rotation from the z M axis to the 
Zj axis about the x { axis; a j = (Zj.^Zj) 


SPECIFICATION OF °T 6 MATRICES 

The description of the end of the manipulator, in terms of 
homogeneous transformations, is given by 
nJ T 6 = A n A n+1 ....A 6 . (8) 

with respect to link coordinate frame n-1. The description of 
the end point of any link i with respect to link coordinate frame 

j is 

j Tj = A j+ ! Aj + 2 — A j , j<i , (9) 

Commonly the end of the manipulator, link coordinate frame 
6, with respect to the base coordinate is given by the following 
transformation 

T 6 = A i A 2 A 3 A 4 A 5 A 6 • ^ 0 ) 

This is the backbone of the inverse kinematics problem for a 
general 6-axis robot. 

Note that for a revolute joint, all of the parameters are held 
constant except for the link angle 0. For a prismatic joint the 
only variable is the distance d, while the other parameters are 
held constant. The four link parameters present sufficient in- 
formation to mathematically represent the lower pair. Once the 
Denavit-Hartenberg parameters are obtained, a homogeneous 
transformation matrix can be developed that will transform one 
link coordinate frame with respect to the next. 

Thus, each A matrix provides a means of transforming from 
the end of one link to the beginning of another. Matrix A would 
represent a transformation from the base coordinate vector 
(usually [0,0, 0,0, 0,0]), to the end of the first link. By perform- 
ing consecutive matrix multiplication operations on the A 
matrices, it is possible to transform from the base coordinate 
vector to the end effector vector (also called the end point state 
attitude vector). For an n-axis manipulator this would be ex- 
pressed by the matrix operation: 

T n = A jA 2 A 3 A 4 A 5 A 6 — A n . 


This means that if the Denavit-Hartenberg parameters and 
the joint coordinate vector is known, then the direct kinematic 
solution can be obtained for a general n-link manipulator. The 
matrix product of the individual A matrices is referred to as 
T n . This is the transformation from base to end effector and 
expresses the position and rotation of the end effector with 
respect to the base. 

We will now apply the above results for obtaining the exact 
solution to a Rhino XR-2 robot manipulator. 


GOVERNING EQUATIONS FOR THE EXACT INVERSE KINEMATICS 
SO LUTIONS FO R THE R HI NO XR-2 ROBOT 

Before attempting to find the exact inverse kinematics solu- 
tions for the Rhino XR-2, we should mention that Paul [3] has 
outlined a procedure that can be used for generating a closed- 
form solution to some classes of manipulators. Basically, it in- 
volves trigonometric manipulation and matrix regrouping to en- 
sure element-to-element equality within the matrices T n and 
the attitude vector. One should also mention the work of Pieper 
and Roth [2] in relating the analysis of closed-loop and open- 
loop mechanisms as well as Duffy and Rooney [12] and Duffy 
[13], who have applied the sine and cosine laws of spatial 
triangles to the equivalent spatial mechanism of a manipulator 
and have obtained closed-form solutions of many special 
manipulators. In our attempt to obtain four sets of closed-form 
solutions to a general 6-axis robot manipulator, we are guided 
by these findings. 

Consider a schematic of the Rhino XR-2 robot manipulator 
as depicted in Figure 2a and b. 


Based on Figure 2a and b and Algorithm 1, the following 
general table for joint parameters can be constructed: 

TABLE 1 

General Table for Joint Parameters of the Rhino XR-2 Robot Manipulator 


Joint 

e i 

a i 

a i 

di 

1 

9 1 

-90° 

0 

d i 

2 

e 2 

0° 

a 2 

0 

3 

0 3 

0° 

a 3 

0 

4 

e 4 

o 

O 

cr> 

1 

a 4 

0 

5 

e 5 

0° 

0 

d 5 


The D-H attitude matrices can now be derived based on equa- 
tion 2 and Table 1 such that 


C] 0 -Si 0 

S] 0 Cl 0 

0 -1 0 di 

0 0 0 1 


-S 2 0 


a 2^2 



a 2 S 2 

0 

1 


(ID 


(12) 



b) 


INVERSE KINEMATICS SOLUTION FOR RHINO XR-2 WHEN a 4 *0 


x 2 




Figure 2. A schematic drawing of the Rhino XR-2 (Figure 2a) shows the configuration of the arm, the end effector, and the shoulder and hand encoders. Kinematics 
solutions for the robot’s axes of motion are represented in Figure 2b. 
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S 4 
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0 
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0 
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A 5 = 
A 4 


C 5 

s 5 

0 

0 


“ s 5 

c 5 

0 

0 


0 

0 

^5 


(15) 


Now the inverse kinematics equations read 

jS - /\l/\2 4 3^4^5 
'O A 0 1 2 3 4 

where T ;j matrix is known and is given by 


T S = 
‘0 


Px 

Pv 


(16) 


(17) 


Now the task is to determine the five unknowns, i.e., 6 lf 6 2 , 
0 3 , 6 4 , 0 5 in terms of the components of the attitude matrix 
T 0 and other structural parameters. One may rewrite equation 
(16) in the following fashion 

(Af) _1 (Aj)" 1 Tg - a|aJa| . 08) 


where 


, a 2 x -1 

(A-j ) 


" S 2 

0 

0 


” a 2 

0 

0 

1 


(19) 


(aJ)' 1 = 


0 

-S, 


0 

-1 

0 

0 


(20) 


Now one can expand equation (18) to arrive at a set of 12 
equations for the five unknowns 9 h 9 2 , 9 3 , 6 4 , 9 5 . Obviously 
there may exist multiple solutions or no solutions at all. Let A* 
be a 4 by 4 matrix defined such that 
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345 ? -1 1-15 

A* = A|A$AJ = (Af) (Aq) 'tJ 


Note that on the one hand 
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Thus 

An* = Cl c 2n x + S-j C2n y - S 2 n z = C34C5 

A 12* = c l c 2°x + s l c 2°y ‘ s 2°z = _c 34 s 5 

A i 3* = <oC 2 a x + S 1 C 2 a y - S 2 a z = -S34 

A i4* = C]C 2 p x + SiC 2 Py - S 2 p z + d]S 2 - a 2 

= "85834 + a 4^34 + a 3 C 3 
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From equation (35) it is clear that 
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From equations (32) and (33) one finds that 
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Multiplying equation (24) by C 2 and equation (28) by S 2 and 
subtracting the results, i.e., A n *C 2 - A 21 *S 2 , yields 


n x C l + n y S l = C 5 C 234 


( 38 ) 


Similarly, multiplying equation (24) by S 2 and equation (28) by 
C 2 and adding the results, i.e., A , , ’ S 2 + A 21 *C 2 , yields 


-n z = C5S234 

Dividing equation (39) by equation (38) yields 


-lr - n z 

6 a . . = 0, + 0, + 0. = tan [— ~ — 2 n c 
234 234 n x C-| + n y s l 


] 


( 39 ) 


( 40 ) 


provided C 5 # 0, i.e., d 5 ¥= (n + l)n/2. Dividing equation (25) 
by equation (24) yields 


"12 

All* 


r c l c 2 °x + S^Oy - S 2 o z 

l— rr — 1 — J = -tanec 

^1^2 n x + S]C2Hy - S2n z 


(41) 


Equation (41) then yields the following expression for 0 2 by 
dividing its numerator and the denominator by C 2 : 


= tan' V 1 ^ * n x tane 5> * S 1 (°y + n y tan8 S ) 

2 L n z tan 05 + o z J v ; 

02 = e 2 + 180° 


From equations (26) and (30) one finds that 


A 13 * . ta ./„ + » . r c 1 c 2 a x + SiC 2 a y - S 2 a z 

A 23 * tan 9 3 ®4 ' -C-|S 2 a x - SiS 2 a y - C 2 a z ] ’ (43) 


which then yields the following expression for (0 3 + 0 4 ): 

-1 C n a v + S 0 a w - a tan0 o 

034 = ( e 3 + 04 ) = tan C r ■, x 2 ' A x 2 J • ( 44 ) 

“ a ^ a + a ~r 


C-|a x tan02 + S-|aytan02 + a z 


From equations (27) and (31) one finds respectively that 


a 3 C 3 sC l C 2 p x +S l C 2 P y ‘ S 2 P z +d l S 2 " a 2 +d 5 S 


34 


‘ a 4 C 34. < 45 ) 


a 3^3 = “ C 2 p z + ^1^2 + d 5^34 ” a 4^34 • (46) 

Dividing equation (46) by equation (45) yields 

,3 . < 4; > 

d l C 2 + d 5 C 34 ’ a 4 s 34 “ c l s 2Px “ s l s 2Py " c 2Pz 
^d-jS 2 + CI5S34 - a 4 C 34 - a 2 + c i c 2 p x + S l C 2 p y “ S 2 p z^ 

Now from equations (44) and (47) one finds that 

04 = 0 34 - 03 (48) 

and thus the inverse kinematics solution set is completely 
determined. 

Alternatively, one may solve the inverse kinematics problem 
by simply expanding equation (16). Thus, one finds the follow- 


ing expanded expressions 

n x = c l c 234 c 5 + s l s 5 > (49) 
°x = _c l c 234 s 5 + s l c 5 » (50) 
a x = " c l s 234 > (51) 
Px = " d 5 c l s 234 + a 4 c l c 234 + a 3 c l c 23 + a 2ClC2 , (52) 


n y = Si C 234 C 5 - C 1 S 5 , (53) 

°y = “ S 1 C 234 S 5 ” C 1 C 5 » ( 54 ) 

a y = S 1 S 234 > (55) 

p y = -d 5S iS234 + a4SiC234 + a3SiC23 + a2SlC2 , (56) 

n z = " s 234 c 5 * (57) 

°z = 523455 > (58) 

a z = " c 234 » ( 59 ) 

Pz = " d 5 c 234 " a 4 s 234 “ a 3 s 23 “ a 2 s 2 + d l • ( 6 °) 

From equation (59) 

0 2 + e 3 + e 4 = Cos (-a z ) . (61 ) 


Multiplying equation (52) by S l and equation (56) by C } and 
subtracting the results, i.e., Sjp x - Cjp y , yields 

Sip x - C]p y = 0 or 0] = tan \p y / p x ) . (62) 


Now if S 234 ^ 0 then from equations (57) and (58) one finds 
that 

0g = tan (’ 0 z /n z ) » ^234^ 9 * (63) 

But if S 234 = 0 (degenerate case), then 0 2 + 0 3 + 0 4 = 
0, ±nrr (vertical approach for Rhino). Thus, C 234 = 1, ±1 
respectively, and from equations (49) and (50) 


n x = ± c l c 5 + s l s 5 = 003(0! + 0 5 ) Cos (0-j + 0 g ) , (64) 

o x = +C1S5 + S-j C5 = Si n ( 0 1 + 05) S i n ( 0 -j + 0^) , (65) 

and therefore 

e l + 0 5 * tan‘ 1 (o x /n x ), of S 234 = 0 . (66) 

From equations (52) and (56) one may easily show that 
c lPx + s lPy = " d 5 S 234 + a 4 C 234 + a 2 c 2 + a 3 c 23 * ( 67 ) 

Now from equations (60) and (67) it may readily be shown that 

a 2 s 2 + a 3 s 23 = d l ■* d 5 c 234 " a 4 s 234 “ Pz = a » ( 6Q ) 

a 2 c 2 + a 3 c 23 = c lPx + S 1 Py + d 5 s 234 “ a 4 c 234 = 6 , (69) 


where a and p are known quantities because 0 2 + 0 3 + 0 4 
is known already. 

From equations (68) and (69) one may easily show that 
a 2 + a 2 = a| + a 2 + 2 a 2 a 3 C 3 , ( 70 ) 

Such that 


-la 2 + B 2 - a 2 
03 = cos [ — 

2 a 2 a 3 


a 3 


( 71 ) 


Here the arc-cosine solution is acceptable because it can easi- 
ly be shown that the argument can not exceed ±1. Generally 
speaking, arc-tangent solutions are preferred because they cover 
the whole domain from -a to +a for their argument. Now, 
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expanding equations (68) and (69) one obtains 

a 3 ( S2C3 + ^2^3) + a 2^2 = a * (72) 

a 3(^2^3 “ $2^3) + a 2^2 = & • (7^) 

Multiply equation (72) by S 2 and equation (73) by C 2 and 
add to obtain 

a 3C3 + a 3 = a 22 + BC 2 • (74) 

Now multiply equation (72) by C 2 and equation (73) by S 2 
and subtract to obtain 

a 3 S 3 = 01 C 2 ~ BS 2 • (75) 


Multiplying equation (74) by p and equation (75) by a and 
adding, one obtains 

3(^303 + a2 ) + aa 3 S 3 = (a 2 + 3 2 )C2 . * (76) 

Multiplying equation (74) by a and equation (75) by p and 
subtracting one obtains 

a(a 3 C 3 + a 2 ) - Ba 3 S 3 = (a 2 + b 2 )S 2 . (77) 


Now from equations (76) and (77) it is readily found that 
„ _ . -1 r a ( a 3 c 3 + a 2) - & a 3 s 3 

0 2 “ tan L B(a 3 C 3 + a 2 ) + aa 3 S 3 J . (78) 

So that from equations (61), (71), and (78) one finds that 
2 2 2 2 

. -1, , „ -l r a £ ^ - a£ ' a3, 

°4 = Cos ^ - Cos £ 2i^ "] 


-1 r ct(a3C3 + a 2) - Ba3S3 
" t3n L B(a 3 C 3 +"a 2 ) + aa 3 S 3 J 


(79) 


This completes the inverse kinematics solutions for the Rhino 
XR-2. 

Table 2 summarizes the inverse kinematics solutions as well 
as their valid ranges for all motions of Rhino XR-2 robot. 


The Rhino XR-2 firmware design is such that when the 
shoulder motor is activated to produce a rotation 0 2 = d, the 
elbow motor is simultaneously activated to produce a rotation 
of 0 3 = -6. Thus, 0 2 + 0 3 remains fixed when the shoulder 
motor is activated. Thus, the orientation of the forearm relative 
to the base will be unaffected by the shoulder motor. Similarly, 
when the elbow motor is activated to produce a rotation of 0 3 
= 6, the wrist pitch motor is simultaneously activated to pro- 
duce a rotation of 0 3 = -d. Thus, the Rhino operation is 
basically such that 0 2 + 0 3 + 0 4 remains constant when 
either the shoulder motor or the elbow motor is activated. This 
means the orientation of the wrist relative to the base will be 
unaffected by either the shoulder motor or the elbow motor. 
Thus, the wrist pitch motor may be used to set the sum 0 2 + 
0 3 + 0 4 , then the elbow motor can be used to set 0 2 -I- 0 3 , 
and, finally, the shoulder motor may be used to set 0 2 . Table 
3 below displays the angular control ranges of the Rhino XR-2 
motors. 


TABLE 3 

Angular Control of Robot Motors 


Motor 

Function 

Angular Control 

A 

Fingers 

-- 

B 

Wrist Roll 

0 5 

C 

Wrist Pitch 

e 2 + e 3 + e 4 

D 

Elbow 

e 2 + e 3 

E 

Shoulder 

e 2 

F 

Body (Base) 

e l 

G 

Carrousel , etc. 

-- 

H 

Spare, etc. 

— 


Now consider the home joint vector 0 h , i.e., 0 h = (0°, -90°, 
90°, -90°, 0°) T . Let motor angles be denoted by <)> m = (<j> i, 
$2, +3i +4> +5) T - Note that + ! = 0„ <f> 2 = 0 2 , + 3 = 0 3 +(0 2 
- 0 2 ) - 02 + 03 + 90°, +4 = 04 +(0 2 - 0 2 h ) + (0 3 - 0 3 h ) 


TABLE 2 

Inverse Kinematics 
Solution for the 
Rhino Robot 


Joint 

Solutions 

Valid Range 

1 

8 ] = tan (p y /p x ) 

-180°<e i: <180 o 

2 

.._-lr a(a 3 c 3 + a 2> - 6 a 3 s 3 n 

2 B(a 3 C 3 + a 2 ) + aa 3 S 3 

- 9 O°<. 0 2 < 9 O° 

3 

2 2 2 2 
_ l a + B - ao - ao 

0 3= COS [ 2 a 2 a 3 ^ 

0°<e 3 <180° 

4 

2 2 2 2 
^ -1, , „ -1,ci + 6 - ao - * 2 -, 

e 4 = Cos (-a z ) - Cos [ 1 -] 

2a 2 a 3 

-l r a ( a 3 c 3 + a 2) “ Ba 3 S 3 
tan L 3 ( a 3 c 3 + a 3 ) + aa 3 S 3 -l 

-270 o <6 4 <90° 

5 

05 = tan’l (-o z /nz). if S 234 j* 0 
+05 = tan \py/p x ) - tan ^Ox/nx), if S 234 = 0 

- 18 O o < 0 5 < 18 O° 
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= 02 + 03 + 04 = 0 234 and ^5 = 0 5 - It is clear that 


0 

-90 



-90 


0 


(80) 


Furthermore, 


1 

0 

0 

0 

o" 


"6" 

0 

1 

0 

0 

0 


0 

0 

1 

1 

0 

0 

A0 + 

90 

0 

1 

1 

1 

0 


0 

0 

0 

0 

0 

1 


0 


(81) 


where A£ and A0 are incremental changes in joint motor 
angles and the joint angles respectively. 

The following algorithm can be used for the inverse problem: 

Algorithm 2. 1. Calculate 6 h 6 2f 0 3f 6 6 5 using Table 2; 

2. Drive the wrist motor B to the position <t> 5 = 0 5 ; 

3. Drive the wrist pitch motor C to the position <|> 4 = 0 2 + 
03 + 04 = 

4. Drive the elbow motor D to the position <|> 3 = 0 2 + 0 3 ; 

5. Drive the shoulder motor E to the position <j> 2 = 0 2 ; and 

6. Drive the base motor F to the position <)> x = 0 

The above procedure can be employed to calculate the desired 
solutions for the joint vector 0 and to translate that in terms 
of the motor angles. The motor angles can then be activated 
by appropriate joint commands through the controller. A flow 
chart can be constructed for these purposes (Figure 3). 

Based on the algorithm given in Figure 3, a computer pro- 
gram can be established to actually implement the inverse 
kinematics solutions for the motion of the Rhino XR-2 robot. 
This program is available on a floppy disk for any suitable 
microcomputer and can be obtained from the author on request. 



Figure 3. Based on this algorithm, a computer program can be established to implement the inverse kinematics solutions for the Rhino XR-2 robot. 
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Forth-83 Standard compilers 
for microcomputers 

For Development: 

Interactive Forth-83 Interpreter/Compilers 
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• Full screen editor and assembler 

• Uses standard operating system files 
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coprocessor support, symbolic debugger, native code 
compilers, and graphics support 


For Applications: Forth-83 Metacompiler 

• Unique table-driven multi-pass Forth compiler 

• Compiles compact ROMable or disk-based applications 

• Excellent error handling 

• Produces headerless code, compiles from intermediate 
states, and performs conditional compilation 

• Cross-compiles to 8080, Z-80, 8086, 68000, and 6502 

• No license fee or royalty for compiled applications 


Support Services for registered users: 

• Technical Assistance Hotline 
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and prices. Consulting and Educational Services 
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urn 


Laboratory Microsystems Incorporated 

Post Office Box 10430, Marina del Rey, CA 90295 
Phone credit card orders to: (213) 306-7412 


Overseas Distributors. 

Germany: Forth-Systeme Angelika Flesch, D-7820 Titisee-Neustadt 
UK: System Science Ltd., London EC1A 9JX 
France: Micro-Sigma S.A.R.L., 75008 Paris 
Japan: Southern Pacific Ltd., Yokohama 220 
Australia: Wave-onic Associates, 6107 Wilson, W.A. 
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ATTEND ROBOTS EAST 



ROBOTS EAST* OCTOBER 9-11, 1985 

BAYSIDE EXPOSITION CENTER • BOSTON, MASSACHUSETTS 
INFORMATIVE... 

At ROBOTS EAST you’ll learn how robots can make your company 
more productive and profitable while improving product quality. 

Featuring the latest robots, sensors, components, controls and related 
equipment, the exposition is designed for manufacturers in all industries. 

INSIGHTFUL... 

You’ll gain new insights into robotics by attending special trade 
seminars conducted by top robotics experts and by touring leading 
East Coast robot installations. You’re encouraged to challenge our 
experts with your specific needs. 

WORLD-CLASS! 

ROBOTS EAST is sponsored by Robotic Industries Association, 
sponsor of the prestigious ROBOTS 9 and ROBOTS WEST 
expositions. ROBOTS EAST will uphold the RIA tradition of 
sponsoring only the finest robotics events. 


FOR MORE INFORMATION, CALL OR WRITE RIA TODAYI 


Robotic Industries Association 
II P.O. Box 1366 
LI™ Dearborn, Michigan 48121 

Telephone: 313/271-7800 
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PREVEWIN6 ROBOTIC 
MOTION WITH 

COMPUTER GRAPHICS 


William Kovacs 
Wavefront Technologies 
1421 State Street, Suite H 
Santa Barbara, CA 93101 


By anyone’s definition, the field of 
robotics is a broad one. A tremendous 
variety of robot configurations are now in 
use or being designed. They range from 
simple, numerically controlled positioning 
devices to fully autonomous, mobile data- 
gathering devices sophisticated enough to 
collect information about their surround- 
ing environments and act on that informa- 
tion. Between these extremes there exists 
a large array of jointed arms devised for 
various industrial applications. In every 
case it is possible to use three-dimensional 
computer graphics as an aid in the design, 
programming, and guidance of these 
devices. Designers can use graphic systems 
to visualize configurations before a pro- 
totype is made. In the area of reprogram- 
ming, computer graphics can save time 
and even eliminate the need for access to 
the target device for the reprogramming 
stage. When designing and controlling the 
most complex, autonomous robots, com- 
puter graphics can be used to evaluate how 
the robot will react to and perform within 
a three-dimensional environment. 

Over the last year, Wavefront 
Technologies has developed a program 
called PreView that provides a great many 
of the capabilities mentioned above. 
Although it is intended to be a general- 
purpose visual simulator, it incorporates 
some features that are particularly useful 
in robotics. Our design philosophy has 
been to provide a dynamic and interactive 
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environment on a high-performance 
engineering workstation. The goal is to 
shorten the design/evaluation loop so 
more configurations can be explored in a 
given time period than has been possible 
with previous approaches. Although com- 
puter graphics have been used in the past 
for various simulations, most of the soft- 
ware packages available have been relative- 
ly special purpose and therefore somewhat 
limited in the kinds of scenarios that can 
be simulated. Depending on the speed of 
the graphics hardware, PreView can 
render scenes of 10,000 vectors in real 
time (30 fps). The software is written in C 
and currently runs under the Unix 
operating system. 

The basic primitives incorporated in our 
software are objects, viewpoints, and light 
sources. Objects are the “actors” in 
the computer-generated simulation. 
Associated with each object is a list of 
three-dimensional coordinates that 
describes the overall shape and size. These 
coordinates can be entered in a variety of 
ASCII and binary formats, which makes it 
easier to take advantage of any existing 
modeling software. A given simulation 
might have many of these objects moving 
independently or connected to one 
another. Each object may be free to move 
in one or more ways. These freedoms of 
motion can be reduced to combinations 
of translation, rotation, and scale in the 
X, Y, and Z axes. The base of a crane, for 


example, may be free to move along a 
horizontal track while simultaneously 
rotating. Scale transformations can be 
used to describe objects such as springs 
or cushions that stretch in one or more 
dimensions. Within PreView, each 
separate freedom of motion is referred to 
as a channel. A channel can be thought 
of as a stream of data describing a par- 
ticular motion in a particular axis such as 
X translation or Z rotation. Each of these 
channels can be used to represent a motor 
or an actuator in the real world. Although 
each motor may have its own gearing ratio 
or specific operational parameters, we 
chose to describe the motion in terms of 
pure transformations in three-dimensional 
space because this isolates the graphic 
previewing from the specifics of the motor 
attachment. If, for example, a stream of 
numbers must be generated in terms of 
pulses for stepper motors, the conversion 
is done as a final output step. This is 
directly analogous to the metafile concept 
used by various CAD systems where a 
drawing or part is represented in a generic 
form and then translated at output time 
to a format specific to a particular plotter 
or display device. 

In order to actually display a motion se- 
quence, there has to be a predefined van- 
tage point from which this motion is to be 
seen. For maximum flexibility, PreView 
supports multiple viewpoints. One use of 
this capability is for generating top, side, 




and front views of a given assembly. View- 
points can also be attached to objects. This 
enables PreView to create simultaneous 
views of the same scene from the vantage 
point of the robot and a stationary or mov- 
ing observer. Viewpoints can be defined 
as either orthographic or perspective. 
Perspective views will render a scene in the 
same way as a camera or eye would see 
it, that is, with progressive foreshortening 
with distance. When using perspective 
views, PreView can exactly simulate an op- 
tical system once focal length, aperture, 
and aspect ratio are specified. In contrast, 


orthographic projections are undistorted. 
They allow measurements to be made 
directly from the projections. 

The designation of light sources and 
their position becomes increasingly impor- 
tant when renditions of higher realism are 
required. The locations of light sources 
may also come into play where the amount 
of lighting on a given task is critical or in 
question. As is the case with objects and 
viewpoints, light sources can have motion 
channels associated with them. This allows 
us to preview a change in position or “aim” 
a light source. 


HIERARCHICAL DISPLAY TREE 



Figure 1. Objects in a given scene that are related to one another, such as the fingers of a robot hand, 
can be described as having a common “parent,” the palm of the hand. The attachment scheme is here 
depicted as a hierarchical tree. 


PREVIEW FILE ORGANIZATION 


OBJECT 1 

A 


"V 


OBJECT 2 
A 


“V 


OBJECT 3 

A 



Figure 2. The PreView database is created by assembling a number of one-dimensional vectors into a matrix, 
in which columns represent channels of motion and rows represent frames or sample points in time. 


As alluded to earlier, the objects in a 
scene may be connected to one another. 
Our method for describing this is to assign 
a given object to a “parent” object. Doing 
so tells the computer that all motion of the 
“offspring” object is relative to its parent. 
Many objects may share a common parent. 
In the case of a robot hand, for instance, 
all the fingers would have the palm of the 
hand as their parent. If we diagram this 
attachment scheme we see a hierarchical 
tree (Figure 1) that describes the entire 
connectivity of the assembly. PreView 
allows the user to interactively edit this 
hierarchy prior to display. 

As is usually the case in three- 
dimensional computer graphics, PreView 
uses 4 by 4 matrices internally to describe 
object transformations. A single 4 by 4 
matrix can represent all of the translation, 
rotation, and scale transformations being 
applied to a single object. PreView re- 
quires the user to specify the order in 
which the channels are combined to form 
the resulting matrices. This is necessary 
because many transformations are non- 
commutative; different ordering of the 
same transformations will yield a different 
visual result. In the case of a gimbal 
mount, for instance, the ordering of the 
rotations must be specified to yield a cor- 
rect simulation. 

In order to achieve maximum playback 
speed, PreView precompiles the display list 
into an extremely fast form that executes 
on a frame-by-frame basis. To quickly 
display a hierarchical attachment system, 
PreView uses an internal matrix stack. 
Transformations for a given object are con- 
catenated in a single matrix, and this 
matrix is “pushed” onto the stack. For 
displaying all objects attached to that ob- 
ject, the matrix stack is pushed, leaving the 
current matrix on the top. The transfor- 
mations for the sibling objects are then 
concatenated onto this matrix. When the 
next sibling object is displayed, the matrix 
stack is “popped” to restore the matrix 
that was in place for the parent object. 

We have said that a scene can be 
thought of as a collection of objects, each 
controlled by one or more channels of mo- 
tion. The data required to uniquely 
describe a specific state consists of a value 
for each channel (a one-dimensional vec- 
tor). In order to represent motion we sim- 
ply need to assemble a number of these 
vectors into a matrix where columns repre- 
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sent channels and rows represent frames 
or sample points in time (Figure 2). This 
is roughly how a PreView database is struc- 
tured. The current implementation of the 
program uses single-precision floating- 
point numbers to store channel data. To 
generate a dynamic display of the scene, 
the software indexes from frame to frame 
in the database, updating the matrix 
transformations and applying them to the 
associated objects for display. PreView im- 
poses no limits on the dimensions of this 
matrix in terms of channels or frames. Fur- 
thermore, the database can be extended 
at any time to accommodate more objects 
or frames. The PreView database can also 
accommodate nongraphic channels of any 
type. It may be necessary, for example, to 
include temperature readings with several 
objects at specific times. Even though 
there may be no way to incorporate this 
data into the display, the readings can be 
synchronized and/or listed with the 
motion data. 

In the same way that a spreadsheet pro- 
gram allows the accountant to modify 
several numbers in the matrix and observe 
the consequences, PreView allows the 
robotics designer to modify the data con- 
tained in channels and observe the visual 
results of that modification. Typically the 
user does not enter data a frame at a time 
but rather specifies key frames and then 
employs a variety of numerical techniques 
for making smooth transitions between 
those key points. At present, PreView can 
generate cubic splines and exponential 
curves as well as simple linear transitions. 
Each channel’s key frames can be posi- 
tioned at different points in time. Editing 
functions allow the user to move channel 
data from one channel to another or shift 
it forward or backward in time. Other com- 
mands provide for arithmetic operations 
( + , -, /, *) on and between channels. 

PreView also allows the user to enter 
channel data from an external source. For 
instance, a set of trajectories computed by 
an analysis program may need to be 
entered into the database so the graphic 
results can be seen. Conversely, PreView 
allows for direct output of all channel data. 
These would be the actual data streams 
required to recreate the motion of an ac- 
tual robot. As previously mentioned, 
because each channel may be representing 
a motor with unique properties, the 
PreView database stores a unique scaling 
factor for each channel output. In addition 

1 8 ROBOTICS AGE August 1985 


to conversion factors each channel may be 
uniquely constrained so that only data in 
a specified range can be entered. The user 
can thus specify ranges of motion. 

Figures 3 and 4 provide examples of 
typical PreView displays. Figure 3 shows 
two orthographic views and one perspec- 
tive view of the same robot arm. The posi- 
tion and aspect ratio of each view can be 
specified exactly. Figure 4 shows the in- 
teractive menu for selecting key frames. 
Menu boxes on the right are used to 


specify the current position for up to 18 
channels selected from the database. Menu 
boxes on the left are used to specify 
various display modes and execute special 
functions. Interactive selection of these 
menu boxes is accomplished with a mouse 
or a joystick. The scale immediately below 
the frame is used for moving forward and 
backward in time. Based on the part of the 
scale that is touched, the rate of advance 
through the database can be varied from 
one to ten frames at a time. 


Figure 3. The same robot arm is shown in two orthographic and one perspective view. 


Figure 4. An interactive menu is used for selecting key frames. The menu boxes on the left specify various 
display modes and execute special functions and those on the right specify the current position for up to 
18 channels selected from the database. The scale below the frame is used for moving forward and backward 
in time. 













Circle 16 


Frame 

# 

| YTRAN 
in. 

1 1/ 2 

ZTRAN 
in. 
1/ 3 

PITCH 
deg. 
1/ 4 

YAW 
deg. 
1/ 5 

ROLL 
deg. 
1/ 6 

XTRAN 
in. 
2/ 1 

YTRAN 
in. 
2/ 2 

ZTRAN 
in. 
2/ 3 

1 

| 2.2366 

8.8306 

0.0000 

43.945 

89.915 

0.0276 

0.0000 

0.0000 

2 

| 2.2117 

9.0294 

0.0000 

43.945 

89.915 

0.0276 

0.0000 

0.0000 

3 

| 2.1872 

9.2256 

0.0000 

43.945 

89.915 

0.0276 

0.0000 

0.0000 

4 

| 2.1629 

9.4191 

0.0000 

43.945 

89.915 

0.0276 

0.0000 

0.0000 

5 

| 2.1390 

9.6102 

0.0000 

43.945 

89.915 

0.0276 

0.0000 

0.0000 

6 

| 2.1154 

9.7986 

0.0000 

43.945 

89.915 

0.0276 

0.0000 

0.0000 

7 

| 2.0922 

9.9846 

0.0000 

43.945 

89.915 

0.0276 

0.0000 

0.0000 

8 

| 2.0692 

10.168 

0.0000 

43.945 

89.915 

0.0276 

0.0000 

0.0000 

9 

| 2.0466 

10.348 

0.0000 

43.945 

89.915 

0.0276 

0.0000 

0.0000 

10 

| 2.0242 

10.527 

0.0000 

43.945 

89.915 

0.0276 

0.0000 

0.0000 

11 

| 2.0022 

10.703 

0.0000 

43.945 

89.915 

0.0276 

0.0000 

0.0000 

12 

j 1.9805 

10.876 

0.0000 

43.945 

89.915 

0.0276 

0.0000 

0.0000 

13 

| 1.9591 

11.047 

0.0000 

43.945 

89.915 

0.0276 

0.0000 

0.0000 

14 

| 1.9381 

11.215 

0.0000 

43.945 

89.915 

0.0276 

0.0000 

0.0000 

15 

| 1.9173 

11.381 

0.0000 

43.945 

89.915 

0.0276 

0.0000 

0.0000 


Figure 5. Preview’s numeric output takes the form of a computer printout. Several channels of data appear 
in this example. 



Figure 6. Channel data versus time can be represented by two-dimensional graphs. Channel data appears 
along the left-hand scale and time or frames appear along the bottom. Tick marks indicate key frames. 


Figure 5 shows a numeric listing of 
several channels of data. 

In addition to three-dimensional displays 
and alphanumeric listings, PreView can 
create two-dimensional graphs of channel 
data versus time. Figure 6 shows such a 
graph with channel data along the left- 
hand scale and time or frames across the 
bottom. Key frames are shown with tick 
marks on the various curves. 

PreView has been successful in helping 
to visualize a wide variety of design prob- 
lems, and work is continuing on additional 
features. Various types of special-purpose 
routines will be required to compute valid 
orientations in cases where objects are 
multiply constrained, such as a piston that 
is constrained by both the cylinder and the 


crankshaft. Consideration has been given 
to the input of real-time data into the 
database. Increased realism in graphic im- 
ages will become increasingly important as 
engineers begin to rely more heavily on 
digital computer graphics in presentation 
as well as in the design phases of a project. 


Bill Kovacs is vice president of research and 
development at Wavefront Technologies. 
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DIGITAL 
REMOTE 
POSITIONER 

MODEL VTSND23-P2 


Microprocessor 
compatible, 
self-contained 
closed loop servo 


Features 

• 8 and 16 bit input 

• 10' accuracy 

• TTL or CMOS compatible 

• 5 in.oz. stall torque 

• Requires only ± 15 VDC power supply 

• Continuous rotation, 400 rpm 


slew rate (max.) 


Also available as analog units 
utilizing synchro or resolver input. 



Vernitron Control Components 

A Division of Vernitron Corporation 
1601 Precision Park Lane 
San Diego, CA 92073 
Tel. 619-428-5581 
TWX: 910-322-1862 


STEPPER 

MOTOR 

CONTROL 



INTERFACES IBM-PC 
OR APPLE 

HS-2 BASIC Controller, HS-3 
Dual Driver, 2 SM-101 
90 oz. motors . . ... $ 416.00 

CyberPak 

* company 

P.O. Box 38 
Brookfield, IL 60513 
(312) 387-0802 
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Circle 4 





FROM PUHES 
OF MOVENENT 

Dr. Robert E. Parkin 
Electrical Engineering Department 
University of Lowell 
One University Ave. 

Lowell, MA 01854 


The three joints of most use in a robot are shown in Figure 1 together with their symbolic equivalents. Suppose a link with 
a sliding joint is connected from point u and is directed along vector a = [cr j cr 2 cr 3 ], then the end of the link is at point v = 
u + oa, where 1 < o < o and o is usually less than 2, and {a 1 2 +a 2 2 +a 3 2 } 1/2 is the shortest length of the link. Strictly speak- 
ing, a and v are not conformable since vector a is a three tuple and v is a four tuple, but if a is considered to be a four tuple 
with zero fourth entry, the inconsistency is avoided (or v-u treated as a three tuple since its fourth entry is zero). This fiction 
is used for compactness. 



c) 



CYLINDRICAL 




Figure 1. The sliding, revolute, and cylindrical forms of robot joints are shown, along with their geometric equivalents. 
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Suppose a joint involving rotation connects links P 2 and 8 2 , and the plane of movement p of the first link is known, then 
link ? 2 moves in plane q where 

(i) p = q if the joint is revolute, 

(ii) p * q = 0 if the joint is cylindrical. 

The revolute joint is shown as a circle joining the two links with a dot in the middle to indicate the direction of the hinge pin. 
The cylindrical joint is shown as a circle with the pin of the hinge joint in line with one of the links; the other link will always 
be orthogonal to the first link. Notice that the cylindrical joint has orientation and can be connected in one of two ways. We 
consider the joint and the link to which it is connected as composing a degree of freedom. Other joints used in robotics can 
always be expressed in terms of the three joints defined above. There are other ways of designating robotic joints [1,2], but the 
notation adopted is consistent with the philosophy of the planes of movement. 


THE REVOLUTE JOINT 


We define the movement of a link following a joint of a robot in terms of the plane of movement of the link preceding the 
joint. Consider the revolute joint of Figure lb. We know the location of the end points u and v of link Bj which moves in plane 
p and wish to determine the location of the end w of link t 2 in terms of link ^ and angle of rotation 0. From Figure lb we see 
\a\ = 4 2 cos 0 and \p\ = B 2 sin 0. a is in the direction of link Bj and p, a, and the vector partially specifying plane p are mutually 


orthogonal, so 
a = (v-u)cos 0 and p - k 


X a where k is a scalar and vector 


is directed into the paper in Figure lb, and k = 


tan 0. The order of the cross-product ensures that a clockwise rotation is positive. 
Thus 

w-v = « 4 ^ « + tan G 


'a 


*2f 

■ 0 

-c 

b 

b 

Xfl = 

— (cos <* + sin t) 
'll 

c 

0 

-a 

.C j 


,-b 

a 

0, 


i 

}■< v-u) 
J 


h 

•i 


c os 0 -CBin 6 bsin 0 

C5in 0 cos G -asin G 
‘bsin G a sin $ cos G 


(v-u) 5 Fuv-u) 


( 1 ) 


If R(0) = R, then R(-0)R(0)v - v for any v. 


THE CYLINDRICAL JOINT 

The cylindrical joint is connected as shown in Figure lc. Link#! moves in plane p = [a b c d] and link # 2 moves in plane 
q = [e f g h], where p and q are orthogonal. The projection of link B 2 on p is vector a, and for ip = 0, w is on p and w-v 
= a. q is defined in part by the direction of link 0] , i.e. 


e 

f 

Q 


1 


(v-u) 

1 


a 


From the geometry, p = -t 2 s\n xp 


b 

c 



e 


a 


0 

c 

-b 

« - t.,cos 4' 

jL 

f 

X 

b 

i 

jL 






= - —cos 4- 

-c 

0 

a 


9 


c 

1 

b 

-a 

0 . 


and w = v + a + p. 

The preceding analysis assumes we know p, u, v, and ip, and we seek w and q. If we want to use the cylindrical joint the other 
way around (given q, w, v, and ip and so seek to determine p and u), we rewrite the equations as 


• 

0 

~Q 

i ' 



a 

cos «}• 

9 

0 

-e 

- 5 i n 4* . I 


b 


-f 

e 

0 . 



.c . 
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-1 



a 


5i n 

♦ 

geos 4* 

- f C 0 5 

f 

SO 

b 

-i 

-qcos 

♦ 

5i n 4* 

ecos 

•1' 



/ 

jL 







. C . 


f C 05 


-ecos 4« 

sin 

'!■ 




COB 

♦ 

-gsin f 

i si n ( 




-l 

<L 

gsi n 

♦ 

COS t 

-esin 4 

(w 



2 

-f sin 

♦ 

esi n { 

cos 4 . 



where <(> = 90 -yj. Point u 



and plane p is completed with d = -(au x +bu y +cu z ). 


( 3 ) 


ROBOTIC MOVEMENT IN PLAN ES 

To avoid any ambiguity, the following angular notation is adopted: G refers to a revolute joint, <|> refers to a cylindrical joint 
connected so that the down-link (closer to the base) moves in the same plane as the up-link (closer to the end effector), tp refers 
to a cylindrical joint connected so that the down-link moves in a plane orthogonal to the up-link, and a refers to a sliding link. 

Figure 2 shows the joint combinations that produce a few of the many 3 degrees of freedom robots and the planes of movement 
of the links. We can make some general observations about robots. It is necessary but not sufficient for the robot to move in 
two independent planes in order for the end effector to reach any point in three-dimensional space. If in plane p, a joint or end 
effector covers a finite area (assume that at one end of the chain of links that move in P; the prior link that does not move in 
Pi is fixed, then the joint or end effector at the other end of the chain of links must move over some finite area), then we say 
that Pi has area and designate it as p*. This occurs whenever a chain of two or more joints and links are in the same plane. 


limited time SPECIAL OFFER: 


SCORPION MOBILE ROBOT KIT 



World leaders in instructional robotics 

RHINO 

ROBOTS 

3402 N. Mattis Ave. 

P.O. Box 4010 
Champaign, IL 61820 
(217)352-8485 


Originally $660 factory 
NOW ONLY $299* oniy 
SAVE OVER 50% 

The package price gives you the Scorpion kit with everything 
needed for assembly plus our 250-page assembly and operation 
manual (a $20 value) as a free bonus. 

The Scorpion is a versatile floor mobile robot that can be run 
from the RS-232C port of any computer, small or large. It is designed 
specifically for the serious robotic enthusiast who owns a personal 
computer and would like to experiment with robotics, artificial intelli- 
gence, machine intelligence, pattern recognition, and mobile robot 
theory. These activities are permitted by the Scorpion by virtue of its 
unique features, which include 2 drive motors, 4 bumpers with 2 micro- 
switches each, 2 programmable eyes, a speaker with tone and dura- 
tion programmability, a 2 axis optical scanner tha allows patterns of 
the brightness of the robot’s environment to be displayed on the CRT 
of the computer, and a 2 phase floor scanner that can be used to 
allow the Scorpion to track the floor environment in an intelligent 
manner. 


Enclose check or money order with order. VISA or Mastercard charges 
accepted. 'Power supply not included. Shipping extra. 
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Circle 10 


To reach any point in three-dimensional space, it is necessary that the robot links move in (a) at least two independent planes 
and that one of the planes has area, or (b) at least three independent planes if none of the planes has area. 

These requirements mean that a minimum of 3 of degrees of freedom are required to reach any point in three-dimensional 
space. The robots appearing second and third in Figure 2 do not have planes with area. We classify these robots as stiff— sometimes 
requiring large changes in the status of two joints for a moderate change in end effector position. A two-link addition as shown 
in Figure 3 to the 3 degrees of freedom robots of Figure 2 enables the end link to assume any position and orientation. 

GEOMETRY SOLUTIONS GEOMETRY SOLUTIONS 







Figure 2. The joint combinations that produce many of the 3 degrees of freedom robots are depicted in the left-hand column (a-i) and their solutions appear 
in the right-hand column (a-i). 



Figure 3. A two-link addition to the 3 degrees of freedom robots in Figure 2 enables the end link to assume any position or orientation. 
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SYMBOLIC FORWARD KINEMATIC SOLUTIONS 


Suppose the 3 degrees of freedom robot shown in Figure 2a, left-hand column, has its base at the origin, so Uj = 


and the base orientation the x-y plane so p 2 =[0 0 10]. We assume that for 4> i =0 the robot moves in the x-z plane. 


Since p x and p 2 = [a b c d] are orthogonal, [a b c] 


= 0, so c = 0. 


Since p 2 u 2 = 0, then [a b 0 d] 


= 0, and d = 0. 


A point on p 2 is 


COB 

sin 

0 

1 


, so acos ^ + bsin ^ = 0. 


Since the plane is normalized a 2 + b 2 = 1, a = sin <t>j and b = -cos $\- 


b 8 s i n 0,, 

X. X. 


CCS 0 » r 
•j 

0 


bsin 

0., 

j 

0 


h H .. s i n 0 . 

-a4 0 sin S,, 

4 X 1 

4, 

.j 

f — 

0 

C O 5 

e , 

~ a s i n 

8, 

>> 

0 


- a tf s i n 0 

a + 5 0 C O 5 0 .. 
1 

X. 

-bsin 0, 
0 

asi n 
0 

0_, 

cos 

0 

0. 

0 

1 


0 _ COS 0 r> 
0 


-cos $ {(! sin 0 + 2 (cos 0„.sin 0„ + sin 6^-cos 8_)1 
112 l s j 2 J 

-sin 0 r) + Q_,(cos 0 7 .sin 0^ + sin 0^*cos 0, } )j 

M^cos l^iCDs 0 . c d s 0^ - sin 0^*sin 0 r> ) 

1 ^ fc O V> X. V.' X. 

1 


-CD5 f 


,{*2 


sin 0 O + 4 7 sin (0,, + 0 ) 

X. O X. o 


} 

-sin ^[^sin 0,, ♦ ^sin <6 2 +6 3 ) } 
tj + ^cos 0 n + 4, cos < 0 2 +0 3 > 


(4) 


For the 3 degrees of freedom robot shown in Figure 2d, left-hand column, and the same base orientation and position as in 
the prior example, p 2 is the same and the end effector is at 

-cos >j« ? sin 0 ? 

-sin f 1 C ? sin 0 O 

= * (5) 

4 +4„cos 0 O 

lx. x. 

1 


where 4 2 is the length of the sliding link. 

Appearing in Figure 2a, left-hand column, is a robot that is capable of reaching any point in three-dimensional space with its 
last link in any orientation, using the orientation linkage shown in Figure 3. This robot has one plane with area, called p 2 in 
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the figure. u 5 can be calculated using equation (4) with 0 3 replaced by 0 3 + tan' 1 ( d 4 /f 3 ) andfl 3 replaced by 


c 3 +? ; 


The Microbot training robot with 5 degrees of freedom shown in Figure 4 has the first three joints as previously analyzed. u 4 
is the same as calculated in equation (4), and straightforward calculations establish 


U 6 = 


-C05 


f f 9 o -I 5 1 

4,|d n 5in 0^ + (l^sin (6+0^) + JK+C-sin ( 0_+$„+6 ,+tan [ 

1 l / v> l o 4 j Z , j 4 « , J 


-sin ^|( 0 sin 0 ,, + t^sin ( 6 0 +e,) + J « ^ + C ^ * 


sin (0,, + 0,<-0 , + tan 
2 3 4 


1 5 


iM 


«,+«„cos 0.+ C .. c o s <0„+0,) + Jc>C-sin ( 0„ + 0„ + 0 , + tan’ 1 —) 
12 Z S 2 o 45 2 j4 H . 

4 


( 6 ) 



Figure 4. The Microbot training robot has 5 degrees of freedom. 

For the SCARA (Selective, Compliant, Articulative Robot for Assembly) robot of Figure 5 and base orientation as given in the 
prior examples, 
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8 Laboratory Microsystems, p. 14 
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Classified 

Advertising 


Personal Robots, Kits and Books at discount prices. 
Cal-Robot, 16200 Ventura Blvd., Suite #223, Encino, Ca. 
91436, (818) 905-0721 

HERO FOR SALE. Fully assembled with arm, voice, remote 
control accessory and memory expansion, with Basic, 
automatic and demo ROMs. 24K additional RAM. EX- 
CELLENT CONDITION. Will pay shipping. $1250.00. Call 
or write: Bruce McGlamery, P.O. Box 2307, Bartlesville, 
Oklahoma 74005. (918) 336-4760 or (918) 333-2086. 

MILLER’S WHEEL AND PINION CUTTING. Write To: 
DAVID G. MILLER, 23V2 E. State St., Alliance, OH. 44601 . 

ROBOTICS SUPPLIES: Stepping motors, translator/driver 
ICs, Hall switches, tools, ICs, transistors, diodes, 
capacitators, resistors, LEDs, breadboarding supplies, wire, 
etc. Competitively priced. Quantity pricing on some com- 
ponents so join resources with a friend and save. 20 page, 
1985 catalog, $1.00. Digimation, P.O. Box 1479, 
Cullowhee, N.C. 28723. 



COMPUTER 

CONTROLLED 

ROBOTICS 




1. DRIVER BOARD 5005 DB $75 * 

4.5” x 3.8” xO.5", TTL/CMOS COMPATIBLE, 

OPTICALLY INSOLATED, FOR 4 PHASE MOTORS 2AMPS/50 VOLTS 

ZLINEAR ACTUATOR 601 AM $ 75 

12V/12W, 16 OZ, .OOl” STEP SIZE 
_ 19 LBS HOLDING FORCE. 3 IN TRAVEL 

3 . LINEAR ACTUATOR 501AM $43 

12V/3.5W, 1.5 OZ, .002” STEP SIZE 
40 OZ HOLDING FORCE, 1.88 IN TRAVEL 

4 . STEPPER MOTOR 201 SM $16 

5V/2W, 1.0 OZ, 15° STEP SIZE 
0.8 OZ/IN HOLDING TORQUE 

5 . STEPPER MOTOR 301 SM $ 59 

12V, 21.5 0Z, 1.8° STEP SIZE 
80 OZ/IN HOLDING TORQUE 

6 . MOTOR MOUNT FOR 301 SM $25 


7 MOTOR MOUNT FOR 501 AM $ 12 
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Circle 1 
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Figure 5. The symbol at u 2 indicates the direction of the pin of the SCARA robot’s revolute joint. 


The symbol at u 2 in Figure 5 indicates the direction of the pin of the revolute joint, so if the plane containing £ la is vertical, 
p 2 is horizontal. 


INVERSE KINEMATIC SOLUTIONS __ 

The inverse kinematic problem has been given considerable attention, and for good reason [3-12]. A paint-spraying robot must 
maintain a fairly constant distance from the object and keep its spray nozzle approximately orthogonal to the point on the surface 
being sprayed. We have just defined a path control problem for the nozzle. A welding robot is required to run the weld rod along 
a seam, another path control problem. A SCARA robot must pick up a printed circuit board and place it in a chassis, avoiding 
other boards and the power supply, yet another path control problem. 

For our examples of robots with 3 degrees of freedom robotic configuration geometries, the inverse kinematic solutions proceed 
from known p lf Uj, and the end effector position. These solutions are shown geometrically in the right-hand column of Figure 

2. These robots yield none, one, or two solutions. Except for the stiff robots of Figure 2, the solutions are in the planes with 
area. The geometric solutions indicate that closed-form algebraic solutions are possible; in other words, symbolic kinematic solu- 
tions can be obtained. Further symbolic inverse kinematic solutions can be obtained from the symbolic forward kinematic solutions. 

When the robot moves in two or more independent planes, the planar representation must be interpreted correctly. The joint 
that causes the most problems is the cylindrical joint, since the planes of movement on either side of the joint are orthogonal. 
The best way to conceive of the actual movement is with fold lines. Consider the geometry shown in Figure 2b, left-hand column, 
where one side of the joint moves in plane p 2 = [a b c d] and the other side moves in plane p 3 = [e f g h], where ae+bf+cg 
= 0. The kinematic solution appears in Figure 2b, right-hand column, where the line of intersection of the two planes is shown 
as dotted and is called the fold line. This line is orthogonal to both links, so the links ^ and fl 2 are always in line in this represen- 
tation. To portray the correct relative position of the planes in space, fold the paper along the fold line hy 90 degrees. The move- 
ment of the cylindrical joint can be seen by considering points and u 2 to be fixed in space and the fold line rotated about 
the axis of link J 1# 

For 4 or more degrees of freedom robots to reach any point in three-dimensional space an infinity of solutions may be possi- 
ble. Such is the case with the Microbot robot. The solution that is often adopted is the one that minimizes joint movement with 
respect to the prior position. 

The algebraic inverse kinematic solution for the 3 degrees of freedom robot of Figure 2a is found from equation (4) as follows. 
For the end effector at point [x y z l] 1 2 , 
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( 8 ) 


? 0 5 i it 0 O + f-jSin (9^+0,,) = -y/sin and 


1 


? 2 cos 0 2 + t jC o s < 9 2 + e 3 ) = z - 8 J , 


where 4j = tan *{y/x}. 

Reordering and squaring both sides of equations (8) can eliminate the compound angle terms and leave 
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— * — —sin 9 - (z - 1! , ) cos 0 = 
sin 2 1 2 
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2 L. 
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(z-^) 


/(2I 0 ) 
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where the left-hand side can be reduced to 
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+ tan 
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and 0 2 found explicitly. 

The symbolic inverse kinematic solution of the 5 degrees of freedom robot of Figure 2a with the orientation linkage of Figure 
3 is obtained from equations (8) by modifying 0 3 and$ 3 as discussed previously. The forward kinematic equation of the SCARA 
robot has a form similar to equation (4), so the inverse symbolic solution is obtained in the same way. 


_ R OBOTS WITH OPEN-FORM INVERSE KINEMATIC SOLUTIONS 

Not all robots have closed-form inverse kinematic solutions. A robot that cannot be solved in closed form (at least by the tech- 
niques employed here) is the 6 degrees of freedom robot with two planes with area and end link orientation as shown in Figure 
6a. Three pieces of information are required to establish plane p 2 = [e f g h], and known points u 3 and u 2 provide two of these. 
Arbitrarily choosing the base angle <j>j will complete the determination. Known points u 6 and u 7 lie on plane p 3 = [a b c d]. 
The third point needed to find p 3 is found by noting that p 2 and p 3 are orthogonal, so [e f g][a b c] { = 0, which is the same 
as considering [e f g 0] 1 as a point on p 3 . 



Figure 6. The 6 degrees of freedom robot shown in 6a does not have closed-form kinematic solutions. Open-form solutions for this robot are illustrated geometrically 
in 6b. 


Point u 4 lies on both p 2 and p 3 , and the line of intersection of these two planes will (except for a degenerate case) cross the 
x-y plane, the x-z plane and the y-z plane; the line of intersection is determined by one or more of the equations. 
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where z^ 


where y 9 


where 


0; 


0; 


0. 


The inverse kinematic solution is shown in Figure 6b, where the points in plane p 2 are shown to the left of the u 4 line and 
the points in plane p 3 are shown to the right of the u 4 line. Consider the u 4 locus to be a 90-degree fold line in the paper to 
get the true orientation of the planes. Notice that 



a 


e] 


b 


f 

u 3" u 4 = 1 

c 

0 

and u^-Uc = ± 

Q 

o 


so links 1 3 and 1 4 must meet the u 4 line at 90 degrees as shown in Figure 6b. This fact establishes the straight line loci for 
u 3 and u 4 shown dotted in the diagram. u 3 must be on a circle of radius 1 2 centered at u 2 , and u 4 must be on a circle of radius 
1 5 centered at u 6 . Choosing one of the two intersection points for u 3 and u 4 and drawing the normals to the u 4 line determines 
error 6 = The choice of points may not be completely arbitrary since 

(i) we want 6 ■* 0, and 

(ii) if the solution is part of a path control problem [10-12] where the u 6 and u 7 are a series of points, continuity dictates the 
choice. 

A strategy must now be employed to refine <f>i, to drive 6 to zero. One such strategy is to change the initial value chosen for 
the base angle 1 for which d 1 was calculated to ^ 2 = <t>j 1 - 1 - A, where A is small, and calculate the new value for the distance 
between the two points on the u 4 line given by d 2 . Assuming d is a linear function of <j>], we choose the base angle to be 


♦1 


2 1 12 
3 „ v 


and continue the iteration provided d 1 +1 < d 1 . 


CONCLUSIONS 

The method of specifying robotic movement developed here enables kinematic solutions to be obtained within the planes with 
area, greatly simplifying the calculations. In most cases, the solutions are obtained symbolically in closed form. 
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GRAPHICS SIMULATION 
AND PROGRAMMMG 
FOR ROBOTIC 
WORKCEU DESIGN 


Over the years, computer aided design 
(CAD) technology has evolved from sim- 
ple, two-dimensional drafting tools to 
engineering design and analysis and 
manufacturing control and programming 
from the same database. Improved soft- 
ware and hardware, which permit toolpath 
generation and N/C postprocessing to be 
performed from the CAD database, repre- 
sent a long step toward the integration of 
CAD with computer aided manufacturing 
(CAM). A further extension of this 
technology is the simulation and program- 
ming of robotic workcells using interactive 
graphics. 

Robot simulation has become an impor- 
tant tool for the Systems Engineering 
Department of Unimation Incorporated in 
the design and implementation of robotic 
systems for industry automation. Develop- 
ment of a robot system involves reviewing 
the industrial process to be addressed in 
the workcell, designing the best system to 
accomplish the task, and presenting the 
designs to the customer. Uses of CAD 
range from the design and manufacture of 
end-of-arm tooling to the installation of 
multirobot systems that interface robots, 
machine tools, and inspection and 
manufacturing equipment with flexible 
communication networks. 

Unimation’s systems engineering depart- 
ment employs a Computervision 
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Robert R. Boren 
Unimation Incorporated 
Shelter Rock Lane 

Danbury, CT 06810 

CGP200X® CAD/CAM system running 
CADDS® 4X Rev 3/0 software. The 
system is used for workcell concept defini- 
tion, engineering analysis, process simula- 
tion, detail-drawing generation, process 
planning, tool design, technical publica- 
tions, and robot simulation programming. 
The entire process relies on CAD, from in- 
itial concept design illustrations and 
engineering analysis to end effector tool- 
ing and custom equipment needed for the 
robotic workcell. 

One very important feature of the CAD 
system is that once a part is defined it 
never needs to be recreated, and it can be 
used for many future applications by be- 
ing extracted from the parts library. Draw- 
ings stored in a CAD system can be quickly 
called up and revised or merged into other 
projects, a significant timesaver since an 
estimated 80 percent of new designs are 
based on existing documents. Because 
drawings in an electronic database do not 
deteriorate, maintenance expenses are vir- 
tually eliminated. Also, documents can be 
sent to remote locations via telephone 
lines or networks. 

The system enables designers to see the 
results of tolerance buildup on the parts 
design and its effect on the entire 
mechanism. Fits and interferences can be 
precisely determined, and design changes 
are immediately reflected in the system 


database. At any time in the design crea- 
tion process, a hard copy or plot can be 
extracted, presenting a view of the 
database components from any desired 
orientation or scale. When a design is 
completed, detail drawings can be ex- 
tracted for parts manufacture. The com- 
pleted system can then be programmed 
from the same design database. 

This computerized approach to 
engineering improves on the old trial and 
error manual approach in many ways. By 
building one centralized engineering 
database, the design of each component 
can be verified graphically and the entire 
workcell simulated before manufacturing 
begins. Designs can be changed and re- 
fined quickly, yielding a precision that 
eliminates the need for costly prototype 
construction. 

In using graphical simulation to design 
and program robotic workcells, the follow- 
ing steps are necessary: 

1. Create the basic workcell in a CAD 
database. 

2. Verify that the robot can reach all re- 
quired equipment. 

3. Modify and refine the workcell. 

4. Verify that the robot can perform the 
desired tasks. 

5. Simulate the robot performing the 
desired tasks. 


ROBOGRAPHICS SOFTWARE PACKAGE 

The software we used for graphical 
simulation and programming of the 
robot workcell is Computervision’s 
Robographics® system. It is composed of 
three modules: the robot path generator, 
a software kinematic model of the robot, 
and the robot output processor. 

The robot path generator allows the 
designer to store necessary information 
about the robot and end effector and to 
use this information when simulating the 
robot in the workcell. The kinematic 
model is a numerical software module of 
the robot complete with arm solutions and 
the motion calculations required to drive 
the graphic figures and accurately repre- 
sent the robot. The robot output pro- 
cessor, which is similar to a postprocessor, 
converts or translates the robot path data 
into the appropriate robot language. 

Before the robot can be simulated and 
programmed on the CAD system, the 
designer must create a 3-D wire frame 
graphics fixture for each link of the robot. 
The designer also creates the graphic 
figures for the end effectors to be used on 
the robot and defines the appropriate con- 
trol points with which the end effectors will 
interface with the workcell geometry. This 
allows the designer to build a library of 
robot end effectors that can be used for 
other applications as well. 


CREATING THE WORKCELL 

The typical workcell in an industrial or 
manufacturing environment consists of 
three groups of equipment: process 
machinery, interfacing or service equip- 
ment, and control systems. The process 
machinery, which performs some function 
on the part or material, might be a welding 
robot, a punch press, or an adhesive ap- 
plicator. Interfacing equipment is 
necessary to serve and manipulate parts 
or material to the process machinery and 
may include conveyors, material handling 
robots, and rotary indexing table. The con- 
trol equipment, which is in charge of the 
manufacturing process and the cell com- 
ponents, can be a robot controller, a 
welding controller, or pneumatic controls. 
In many cases, the robot controller is also 
the system controller that runs the entire 
workcell. 

An extensive 3-D parts library of all types 
of equipment that might be used in a 


robotic cell has been built into our CAD 
system. This library has grown to over 600 
parts and includes various process 
machines, control equipment, material 
handling equipment, and a large assort- 
ment of robot configurations. The robotic 
workcell is created by taking the various 
pieces of equipment needed for the cell 
from the parts library and inserting them 
into the cell database. If a piece of need- 
ed equipment is not in the parts library, 
the CAD designer creates a 3-D model for 
the cell and files it in the library for future 
use. The equipment in the cell is then posi- 
tioned according to the existing process 
flow. 


_ ROBOT REACH VERIFICATION 

After the initial cell layout is established 
in the CAD database, the next step is to 
verify that the robot can reach and inter- 
face with the equipment in the workcell. 
The “CHECK REACH” command from 
the Robographics software package allows 
the designer to quickly optimize the cell 
configuration by inserting the requested 
robot into the cell at a specified position. 


The designer can then tell the robot to 
“reach” the necessary positions within the 
cell. 

The end effector will attempt to move 
to the requested location and orientation 
in the cell and display the location coor- 
dinates and joint angles on the CRT ter- 
minal. If the robot cannot reach its destina- 
tion, the appropriate joints are flagged on 
the CRT to indicate that they have exceed- 
ed their range of motion. At this point, 
while still in the CHECK REACH mode, 
the designer can relocate the robot, reposi- 
tion the cell components, or change the 
orientation of the end effector so it can 
reach the required positions. This cycle 
continues until the cell is optimized for the 
robot selected. If it appears that the robot 
first selected will not reach the desired 
positions, a different robot can be selected 
from the library. 


ROBOT CELL SIMULATION 

When the cell layout is complete, the 
designer prepares it for dynamic simula- 
tion of the robot performing the necessary 
tasks. The command “INS ROBOT” ac- 
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tivates robot simulation and path program- 
ming. The CAD system asks the designer 
for necessary parameters such as which 
robot and which end effector are to be 
used from the library selection, the orien- 
tation of the end effector and control 
point, and the position of the robot in the 
workcell. The system then graphically 
displays the specified robot and end effec- 
tor. The joint angles for each link of the 
robot are also displayed on the CRT 
screen, allowing the designer to monitor 
the motion limits of the robot. When the 
robot attempts to move outside the 
envelope, the joints involved are flagged 
on the CRT. 

With the cell ready for robot simulation 
and path generation, the system gives the 
designer interactive control of each link 
of the robot by means of menu selection. 
By using the menu, the designer has many 
ways of moving the robot about in the 
workcell. Among the choices are explicit 
coordinates that use the CAD geometry 
and surfaces to control the end effector 
and the use of vectors and incremental 
distances. 

When the “TEACH MODE” is selected 
from the menu, the image control unit at 
the CAD terminal becomes a teach pen- 
dant. Using this mode, the designer can 
manipulate each robot link separately in 
either world or local coordinate systems 
and can test many end effector positions 
before teaching the appropriate one as 
part of the robot path. Other menu options 
allow the designer to change robot travel 
speeds, change the working tolerance of 
the end effector, output a plot of the robot 
in a particular position, grasp or release 
objects in the workcell, and add robot 
language statements at any time during the 
robot path creation. 

Interference checking between the end 
effector and workcell equipment is carried 
out by visually following the simulation of 
the robot during path generation. This 
may require simulation of the workcell in 
a number of different perspectives such as 
the top, front, and side views. Only one 
view can be simulated at a time. 

When the designer has finished with the 
INS ROBOT mode, the robot graphics 
disappear from the CRT screen, leaving 
behind the robot path in the workcell. The 
path appears as a series of lines represent- 
ing the end effector’s motions. The 
“DISPLAY ROBOT” command simulates 
the robot in its workcell by either 



P3 


A Unimate Series 500 robot arm has been pro- 
grammed to pick up a workpiece and put it into a 
lathe. When the lathe has finished cutting the part 
into the desired shape, the robot removes the piece 
and inserts it into a laser inspection station to be 
checked for tolerance. The part is then placed into 
either an accept or a reject pallet. Photo 1 shows 
the arm, its end effector, and a pallet. In Photo 2, 
the teach pendant rests on the laser inspection sta- 
tion in the left foreground. Photo 3 is a CAD simula- 
tion of the robotic workcell, control station, pallet, 
and parts conveyor. 
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dynamically or statically following the 
selected path. The designer can also edit 
the path by adding, deleting, or adjusting 
the robot steps. During path simulation, 
time cycles are displayed on the CRT 
screen to allow time comparisons between 
different robot types. 

A satisfactory robotic simulation in the 
workcell signifies the completion of the 
initial workcell design. Next comes the 
detailed mechanical design of special fix- 
turing, end effectors, end-of-arm tooling, 
and interfacing hardware required in the 
workcell. Once the workcell design is 
determined, the robot program can be 
generated from the simulation path. If 
necessary, additional paths can be created 
and verified through robot simulation and 
used for program generation. To translate 
the path into the desired robot language, 
the designer activates the program 
generator, supplies answers to the CAD 
system’s prompts, and selects the robot 
path. At this point, the designer can add 
additional robot language statements to 
the path. The program generator then 
translates the path information into the 
language of the robot to be used in the 
workcell. The robot language, which is in 
the form of a text file on the CAD system, 
can be edited and modified before being 
transferred to the robot controller by way 
of either a direct RS-232 link or a modem 
interface. 

The use of interactive graphics simula- 
tion and programming has greatly en- 
hanced the design and production of 
robotic workcells. Dynamic robot simula- 
tion allows the designer to verify the con- 
cept’s viability from the beginning of the 
design process. The use of CAD to 
enhance design efforts, to simulate, and 
to graphically program the robotic 
workcell has moved automation closer to 
a full integration of CAD with CAM. 


Robert Boren is a senior engineer in the 
systems engineering department of Unimation 
Incorporated. 
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In The Robotics Age 


Continued from page 5 
operator what it thinks it heard. 
The user logs on by repeating 
a series of words spoken by the 
system, and Intel expects that 
this “voice print” will be used 
to keep unauthorized person- 
nel from changing robot con- 
trol programs. 

Two autonomous robots 
were ensconced in adjacent 
quarters, the Arctec Gemini 
and its burly cousin the Den- 
ning Sentry. The pair, unfor- 
tunately, were rarely allowed 
out because of the aisle- 
blocking pedestrian traffic jams 
that quickly collected. Such 
clever cylinders, roaming about 
all on their own, are guaranteed 
to arouse the Gee Whiz in 
everyone. 

AKR Robotics brought along 
a muscular prototype 7-axis 
arm (try to solve for the 
kinematics on that one— and an 
eighth axis can be added by 
mounting the arm on a track). 
The C4000 (Photo 8) aims for 



Photo 8. 


swiftness and accuracy via 
brushless electronically com- 
mutated motors that produce 2 
meters/sec. arm speeds with an 
acceleration of 10 meters/sec. 2 
carrying a 22 lb. payload. AKR 
expects the production model 
to find dispensing applications 
in the automotive industry. 

At Robomatix, we were in- 
trigued by a “Doverential” and 
a new robot teaching device. 
The Doverential, named for its 
designer, is a differential that is 
belt-driven by two equal exter- 
nal motors (Photo 9). It was 



Photo 9. 


developed to power the com- 
pany’s direct drive pick-and- 
place robots and the company 
expects it to replace con- 
ventional one motor-one axis 
drives by allowing power to be 
divided between the two motors 
as required. Robomatix’s other 
unveiling, the Point Teaching 
Device, allows a trainer to stay 
out of the robot’s work 
envelope while using a mouse 
and gridboard to put a SCARA 
through its paces either by 
jumps or in a continuous path. 

Karel’s debut was especially 
impressive even though Karel 
could not be seen, for Karel is 
a new programming language 
developed by GMF Robotics. 
The company fully expects 
Karel to become the industry 
standard programming lan- 
guage and intends to carry out 
all its own future program- 
ming in Karel. A new vision 
system has been developed to 
run on Karel: “In five years,” 
said GMF president and CEO 
Eric Mittelstadt, “if it doesn’t 
have vision you won’t call it a 
robot.” More about Karel will 
appear in future issues of 
Robotics Age. ■ 
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New 

Products 


IGES-Based Software Interface 



aseview™, a software application 
tool that allows access to CAD draw- 
ing information for display on low-cost ter- 
minals is available from Digital Equipment 
Corporation. Baseview supports the Initial 
Graphics Exchange Specification (ICES) 
and can access data from an ICES file that 
has been created on a CAD system. With 
Baseview, engineers can electronically 


New Version of 
Factory Link 

new, real-time, multitasking version 
of FactoryLink™, an industrial infor- 
mation management software system that 
runs on the IBM industrial PC, has been 
introduced by United States Data Corpora- 
tion. Without user programming, the system 
provides real-time color graphics including 
process simulation, machine simulation, 
PID displays, alarms and alarm manage- 
ment, and trending, as well as data logging, 
file storage, computation, and communica- 
tions between all types of monitoring and 
control equipment. 

Compatible with other industry software, 
FactoryLink enables the industrial manager 
to use such programs as Lotus 1-2-3, 
VisiCalc, and Symphony on the factory floor 
to process and manage production and pro- 
cess control information. Its multitasking 
capability allows the user to run and view 
more than one program at a time, switch 
quickly from program to program, and ex- 
change data among different programs. 

For more information, contact: Bob 
Midyett, President, United States Data Cor- 
poration, 1551 Glenville Dr., PO Box 
850058, Richardson, TX 75085, telephone 
(214) 680-9700. Circle 41 


review and approve designs, manufacturing 
departments can verify parts, and purchas- 
ing departments can check part dimensions 
of a design to facilitate ordering. 

Baseview supports a number of graphics 
terminals, such as Digital’s VT240, 241, and 
125 units, as well as Tektronix 4014 ter- 
minals. The display functions support 3-D 
drawings and allow users to pan, zoom, and 


CAD for the Personal 
Computer 

r he Analyst Toolkit® , compatible with 
the IBM PC, XT, and AT systems, 
enables the systems analyst to create 
dataflow diagrams, entity relationship 
diagrams, state transition diagrams, and 
free-form graphics on a unique PC-based 
environment. The mouse-driven graphics 
allow the user to create symbolic graphic 
models on real-time, on-line, and batch pro- 
cessing systems. The Data Dictionary 
feature allows for the integration of graphic 
models through the use of the Diagram Ex- 
traction facility and a PC-based database 
manager. 

The system can automatically interface 
graphic models with other development 
tools such as mainframe data dictionaries 
and fourth generation languages. The error- 
checking facilities of the Toolkit ensure the 
consistency and accuracy of the graphic 
models. Additional features include a com- 
pose facility that allows users to combine 
graphics and text, providing flexible page 
formatting and indexing to give documents 
a finished look. 

For more information, contact: Paul Rad- 
ding, Yourdon Software Engineering Co., 
1501 Broadway, New York, NY 10036, 
telephone (212) 391-2828. Circle 42 


rotate a drawing. The search and query 
features let users search for parts of a model 
and display the dimensions associated with 
the various elements of the object. For more 
information, contact: Reggie Redford, 
Digital Equipment Corporation, Maynard, 
MA 01754-2198, telephone (617) 4674035. 
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HERO SOFTWARE ON A CHIP 

Demorobo— 4K ROM that demonstrates HERO’s abilities 
as well as explain how they work. $49.95 

Abuseramuser-4K ROM that will shock your friends. Gives 
HERO a ’nasty' personality. $49.95 

Henny HERO— 4K ROM that transfers your HERO into 
the king of computer based humor $49.95 

Socket Extender— Relocates any ROM socket for easy 
ROM changes. Cable and zif socket included. $59.95 

2K-4K EPROM burn service available for user designed pro- 
grams. Custom 2K-4K programs written on request. 

Send check or money order to 

Silicon Technologies 
6 Deacon Court 
Melville, NY 11747 
Technical support: 516-643-2069 eves 

Add $1 for S&H. NY state residents please add sales tax. 
HERO is a registered trademark of Heath Comp. Software 
guaranteed defect-free for a period of one year from 
purchase. 
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New 

Products 


Dial Set Capability for 
CAD/CAM Graphics 
Systems 

IJ isc Instruments has announced its 
jL-X“Dial Set” capability for large main- 
frame CAD/CAM graphic systems. This 
lightweight, low-cost, detachable device con- 
tains a fully digitized microprocessor- 
controlled terminal that can be used in con- 
junction with Disc’s series T500, 3-axis 
trackball. The T500 provides systems with 
an X,Y, and user definable third axis that 
can be used for the rotation of 3-D figures 
as well as for zoom. 

The “Dial Set” capability is a multimodali- 
ty manual input device that is available in 
blocks of 4, 8, 12, and 16. It can be pur- 
chased in module form for mounting to a 
user’s panel or as a freestanding device 
designed to the user’s specifications. 

This advanced graphics capability allows 
users to vary all perimeters of a 3-D graphics 
drawing. For example, in an aeronautics ap- 
plication, a user may be working with an 
airplane design that is rotating in different 
positions. To separately perform such func- 
tions as opening cargo doors, or moving 
ailerons, rudders, and landing gears into dif- 
ferent positions such as up and down or 
open and closed, the user would simply turn 
a dial. 

For more information, contact: Peter A. 
Lajoie, V.P. Marketing, Honeywell, Disc In- 
struments Subsidiary, 102 East Baker St., 
Costa Mesa, CA 92626, telephone (714) 
979-5300. Circle 43 


Pen Plotter for CADstation 

r he CADstation™ 2/50, a stand- 
alone, 2-D design/drafting system 
tailored for CAD AM® users, now supports 
a pen plotter. The plotter capability allows 
users with remote sites to obtain a plot 
directly from the CADstation without ac- 
cessing the host computer. Initially, the 
CADstation will support the Houston In- 
struments DMP-52 plotter, which prints up 
to D, Al, or architectural sizes at 16 ips ax- 
ial, 22 ips in all directions, with accelera- 
tion up to 4G. 

For more information, contact: Linda 
Popky, Adage, Inc., One Fortune Dr., 
Billerica, MA 01821, telephone (617) 
667-7070. Circle 45 


Computer Integrated 
Manufacturing System 

F lexible Manufacturing Systems has in- 
troduced a computer integrated 
manufacturing system for robotic transfer, 
storage, and inventory control of semicon- 
ductor wafers in clean room manufacturing. 
The Model 4020 CIM System, which is 
aimed at reducing particulate contamination 
and misprocessing of wafers, is expected to 
improve fabrication line yield by 20 percent. 
Computerized routing of work in process, 
based on wafer lot status and equipment 
availability, will shorten process cycle time 
and reduce work in process inventory, the 
company says. 

A basic CIM System will service 10 work- 
stations. It includes a mobile transport vehi- 
cle that is self-contained and self-propelled, 
two intelligent work in process stations that 
provide local storage and inventory control 
of wafer cassettes or boxes, 10 docking 
modules and operator interfaces, and one 
central control computer with an uninter- 



ruptable power supply, a graphics terminal, 
and software. 

For more information, contact: Joseph A. 
Nava, Vice President, Marketing, Flexible 
Manufacturing Systems, Inc. 16780 Lark 
Ave., Los Gatos, CA 95030-2315, telephone 
(408) 395-2777. Circle 44 


AUTOCAD Version 2.1 

new version of Autodesk, Inc.’s 
AutoCAD™ program, a multipur- 
pose 2-D drafting and 3-D visualization soft- 
ware package for engineers, designers, and 
drafters, has been released. Improvements 
include an interactive pick function, the 
elimination of limitations on drawing com- 
plexity, and a variable and macro facility to 
provide users and application developers 
with the tools to create custom commands 
and functions. 

AutoCAD’s new visualization capability, 
included in Advanced Drafting Extensions 
3 (ADE 3), is the first step in moving 
AutoCAD toward a full-capability 3-D design 
tool. Wire-frame drawings can be viewed 
and plotted, and lines that are obscured by 
other objects in a 3-D drawing can be visual- 
ly suppressed from displays and plots. ADE 
3 also contains the ability to create and edit 
polylines. 

AutoCAD users can expect an overall 40 
percent improvement in the program’s ex- 
ecution speed over AutoCAD Version 2.0, 
the company says. The plotting of drawings 
has been optimized as well, and AutoCAD 


now supports many dot matrix and laser 
printers. 

For more information, contact: Sandra 
Boulton, Autodesk, Inc., 2320 Marinship 
Way, Sausalito, CA 94965, telephone (415) 
332-2344. Circle 46 


Quick Change Tooling 
Adaptor 

T he EOA D-TRAN 25 Quick Change 
Adaptor, part of the company’s 
robotic end-of-arm tooling line, automatical- 
ly quick disconnects air, fluid, vacuum, and 
electrical connections for the D-TRAN 
Multi-Grip family of grippers. The short 
adaptor (1.5 in. long) minimizes tool point 
deflection, weighs less than 1 pound, and 
carries a 25-pound payload. Position ac- 
curacy of 0.001 in. meets operating 
specifications for Seiko D-TRAN robots. 

For more information, contact: Keith 
Crawford, EOA Systems, Inc., 15054 
Beltway Dr.. Dallas, TX 75234, telephone 
(214) 458-9886. Circle 47 
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Expires 


• Signature 

• . 

• Name 


Company 


• Address 


• City State Zip 

• Send to North American Technology 

: 174 Concord St., Peterborough. NH 03458 (603) 924-7136 


ocating sensor 
and transducer products 
—or a specific manufac- 
turer or vendor— doesn’t 
have to be a hit-or-miss 
search through piles of 
general directories any more. 
It’s all at your fingertips in 
The 1985 Sensor and Transducer 
Director y, listing over 500 sensor 
manufacturers and vendors! 
In addition to basic company 
and product information, each 
listing in the 1985 Sensor and Trans- 
ducer Directory includes a list of 
distributors and representatives by 
i geographic location. Convenient indices 
let you locate specific companies by 
the type of sensor that they produce or 
the specific property being sensed. 
If you’re looking for a sensing device— 
be it a thermocouple, pressure sensor, load 
cell, touch sensor, accelerometer, or whatever, 
find it in the 1985 Sensor and 
Transducer Directory \ 
Save yourself the search, and order the 1985 
Sensor and Transducer Director todav! 


□ Please send . 


ONLY $39.95 

. copies of the 1985 Sensor 


and Transducer Directory at $39.95 (includes postage and handling 

costs). Total Enclosed $ 

□ Personal Check □ Cash □ MasterCard □ Visa 


Overseas orders please add $8.00 for airmail postage. 


8/85 RA 















[Overhead Gantry 


SELECTION MENU 

AUTOMATION CONTROL - INTERNATIONAL CYBERNETICS ; CORP; 

Factory Automation Controls for Intelligent Machine Conti 

Flexible Automation Systems Continuous Path Mach 

Press Feeding Automation Profile Milling 

Integrated Cell Controllers Precision Grinding 

Material Handling Semiconductor Manufs 

MAP Compatible Systems 
CIM Control Systems 
Web Processing Systems 

Advanced Technologies for 

Fuily Digital Brushless Serves 

Distributed Servo Controllers 
DNP’“ Servo Technology 
Coordinated Motion Control 

Advanced CYBER-CIM Programming^ 

Licensing Programs ' 1 

Robot Controllers for J| 

Vision Directed Systems hi! 

High-Speed Assembly " 


ICC Lets You Make The Choice 

Our Advanced Technologies Make The Difference 


When it comes to Automation 
Control, you can’t afford to make a 
wrong decision. But with ICC’s 
software-based Flexible Automation 
Controllers, your choice is always 
right. 

With ICC, you’re not locked into 
rigid vendor specs — you choose the 
right control and software package 
that precisely fits your application. 
And that’s why ICC controls are 
setting new standards of excellence 
at virtually every major U.S. manu- 
facturing company. 

Gantry Robot Controllers 

For example, with our cost- 
effective integrated Gantry Robot 
Control System* you can choose up 
to 8 axes of precisely coordinated 
digital motion, inputs for vision 
direction, complete I/O control, 
interfaces with factory networks and 
more. And you also get the industry’s 

* Patent Pending 


most advanced Digital Brushless 
servos that increase production 
speeds over 50%. 

Intelligent Machine Controllers 

When you choose ICC controllers, 
your machines become intelligent, 
fully programmable and simple to 
use. You can even convert your 
existing machines to fully flexible 
manufacturing systems (FMS) 
including Robotic teach -type or off- 
line part programming. And if your 
control requirements increase, simply 
expand your ICC controller by 
adding plug-in modules or software 
packages. 

CIM Factory Control Systems 

You can even choose our new 
Integrated Cell Controller which 
handles the total control of your 
complete manufacturing cell — 
Robotic motion, vision inputs, high- 
speed communication, discrete I/O, 
MAP compatibility and more. 


The Choice is Simple 

By choosing ICC, you’ve chosen 
the industry’s largest selection of 
advanced automation controls 
available. You can choose anything 
from distributed servo positioners to 
complete CIM automation systems. 
And we’ve even made that easy, too. 
You simply make the selection — we 
respond! 


= s international 
== h cybernetics 
= = = corporation 

The Next Generation of Automation Control -Today 

105 Delta Dr., Pittsburgh, PA 15238 
Call 1-800- ICC-CONTrol 
(1-800-422-2668) in PA 412-963-1444 
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